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ABSTRACT 
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design a complete automatic control system for the three dimensional motions of a 
submarine. Automatic control systems are designed using a steady state decoupling 
scheme for vertical and horizontal motion. Both designs are simulated using the Dy- 
namic Simulation Language (DSL; for both linear and non-linear models and compared. 
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Ikctions is also investigated. 
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I. INTRODUCTION 



Since they are operated in three dimensions and because of their dillerent body 
structure and operational conditions, submarines always present a great challange for 
automatic control engineers. IZspecially for submarines with extremely high underwater 
speeds, it is very important to have automatic controls which can be used ellectively. 

In this study, using the equations of motions in six degrees of freedom which were 
developed by Naval Ship Research and Development Center (NSRDC), a linearized 
submarine model was derived for both horizontal and vertical motions. It was obvious 
that working with a linear model is much simpler then with a complete nonlinear model. 
Also the automatic control system design procedures which are used in this study require 
a linear model for decoupling. Cven though the linearized model does not introduce a 
cross-coupling effect between horizontal aitd vertical motion, as would a real submarine, 
it works in almost the same way the nonlinear model does. 

In designing an automatic controller for both vertical and horizontal motions, a 
MIMO ( Multi-input Multi-output ) system representing the submarine, has to be in- 
vestigated. Inputs arc propeller which creates the forward speed, rudder for horizontal 
motion, and the bow and stern planes for vertical motion. The outputs are the three 
speed components u, w, v and roll. yaw. pitch angles around three axes of the submarine. 
Also a ballast system can be used to maneuver the submarine but it is not included in 
this study assuming the submarine is always in trim. 

'I he pitch and yaw angles and the depth have the main importance for maneuvering 
a submerged submarine. '1 herelbre the automatic control system is designed to control 
these three states. 

After obtaining valid linear models for both horizontal and vertical motions, the 
method of the automatic control design has to be chosen. One of the most popular de- 
sign method is optimal control theory but it requires feedback of both position and rate 
information. I his information is available I'or submarines which are equipped with an 
inertial guidance system. For the small coastal submarines which do not have an inertial 
guidance system, a dilferent design approach must be carried out. A possible way would 
be the design of cascaded compensators using only position ( such as depth ) feedback. 

d here is always a cross-coupling effect between vertical and horizontal motion in a 
submerged submarine which is also called a squatting eflcct. d he cross-coupling efl'ect 
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is simply the rudder cOect on vertical plane which makes the submarine pitch up and 
change depth when a rudder angle is applied. The cross-coupling elTcct is also investi- 
gated in this study. 
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II. EQUATIONS OF MOTIONS IN SIX DEGREES OF FREEDOM 



A. BACKGROUND 

With diving capability, submarines diUcr from surface ships, i hey also have com- 
pletely different hull structures, hydrodynamic specifications and relatively complex 
control and stability problems. A submarine can be operated in all six degrees of free- 
dom. To maneuver usually three sets of plane surfaces, the propulsion system consisting 
of one or two propellers, and a ballast system consisting of two or three ballast tanks for 
different type of submarines are used. 

To control horizontal motion the submarine has a usual rudder such as surface ships 
do. But in vertical motion, a submerged submarine needs at least one more control sur- 
face to maintain the desired depth and pitch angle. A classic submarine has bow planes, 
which can be used to keep ordered depth, and stern planes, which can be used to tilt the 
submarine to an ordered pitch angle. Depending on the submarines's speed and condi- 
tion these planes can have an appreciable interaction. 

Modern submarines usually have bow planes on their sails, which are called 
fairwater planes. However, high underwater speeds reduce the necessity of bowplanes. 
It is possible to keep ordered depth without using bow planes while operating with 
higher underwater speeds. Since the numbers presented by NSRDC [Ref 1: p. 88] are for 
an American submarine, bow and fairwater planes were both considered in this study. 

.'\n illustrative picture of a submarine with axes, velocity and plane definitions is 
given in Fig.l. The arrows are pointed in the positive motioit direction. This coordinate 
system is the right hand orthogonal system which is fixed in the submarine and moves 
with it. 1 he origin of the coordinates is located at the center of gravity with x-axis along 
the center plane. The positive x direction is forward, the positive y direction is horizon- 
tally to the right, and the positive z direction is down. [Ref 2: p. 438] 

1 he heading of the submarine is the direction of its x-axis, and this is measured as 
an angle with respect to the geographic coordinate system. The heading angle, also 
called the yaw angle, is defined to be the angle between the direction of the ships x-axis 
and the direction of the x-axis of the geographic coordinate sxstem. d he symbol used for 
the yaw angle is >p. 
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Figure I. A Submai ine Axes of Motion 
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The pitch angle of the ship is the rotation around its y-axis. It is defined to be tlie 
angle between the direction of the ships x-axis and the horizontal reference line. The 
symbol used for the yaw angle is 0 . 

'1 he roll angle of the submarine is the rotation around its x-axis. It is measured from 
the vertical reference to the direetion of the submarine z-axis. 'Ihe symbol used for tiie 
roll angle is 0. 

Veloeitics for the x. y and z directions are u, v and w respectively, which can be 
called velocity components of linear velocity of body axes relative to an earth-fixed axis 
system. 

Definitions for all symbols used in this study are given in Appendix A. 

B, DERIVATION OF THE LINEARIZED MODEL 

The equations of motion are derived by summing the applicable forces and moments 
in each degree of freedom; surge(x), sway(y), heave(z), ro\\{4>), pitch((?) and yaw(\p). 
Reference 1 presents the standard sets of equations of motion developed lor submarine 
motion studies by NSRDC. These equations are general enough to simulate the trajec- 
tories and responses of submarines in the six degrees of freedom resulting from various 
types of maneuvers. '1 hey simulate motion of a given ship design upon insertion of the 
nondimensionalized hydrodynamic cocnicients developed for that particular design. In 
addition values must be supplied for projuilsion force and rudder and diving plane an- 
gles. A complete set of hydrodynamic coeHicicnts and other required data used in this 
thesis is given on Appendix IL 

1 he derivation of equations of motions in six degrees of freedom which are to be 
linearized, was discussed in several earlier studies. (Ref 3 , Ref 4 .) I’he authors were 
satisfied that these equations are valid and can simulate a submarine's motion effec- 
tively. 

1. Assumptions 

Forward speed can be taken as constant. Linearizing about the axial speed, u, 
which affects nearly every term in the standard equations, could be very complex, so the 
forward speed was assumed to be constant. This also reduces the degrees of freedom to 
live. 

Roll angle is assumed to be small. Under normal circumtances in submarine 
maneuvering, the roll angle usually stays within +5°. Large roll angles arc only caused 
by high speed plus hard over rudder. 1 herefore, the roll angle can be neglected. 
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Cross-products of inertia can be neglected. Tliis assumption is conmion to all 
submarine simulations because the hull and interior layout of submarines is approxi- 
mately symmetric. 

All terms including II] can be discarded. Since it is assumed that the submarine 
is in trim, weight of water blown from a particular ballast tank. If], must equal zero. 

All terms involving nonlinearity are neglected. 

Vertical motion is decoupled from horizontal motion. As a result of the first five 
assumptions it also has to be assumed that there is no coupling between vertical and 
horizontal motion. 

2. Derivation of the linear equations of Motion 
a. Lineaviznfion on the vertical plane 

'fhc linearized Ibrm of the equations on vertical plane arc; 

1) Equation of .Motion Along z-axis (Normal Force): 



/mi- - itniq = l^Z^q -f -f Z^iiq) -b y i^{Z^.uw + u^{Z^s^h -b Z^i,db)) ( 1) 



where 



p = 2.0 — rr- . mass densitv oI sea water, 

jp 

/ = 415 ft. , submarine length, and 
/// = 6.2.5.vl0' sings . submarine weight. 

All values for the hydrodynamic cocllicients arc given in Appendix B. 
Substituting these numbers into the equation, and after performing the required algebra 



w = -5.1h/-1.632.vlO“'\/u-+0.261m/-7.416.YlO"VtA-3.71.vlO"V<)b (2) 



2) Equation of .Motion y\bout y-axis: 



(v‘7 = "T + 4" + T -b + BzqO (3) 



After substituting appropriate numbers and required algebra 

q = -4.975.vl0■^i■ -6.219.vl0"A/</ -bl.79S.vl0"A/iv -1.5.vl0“V()s + 3.0.rl0"V(5b 
4-2.516.v1U"^(7 

If these two eiiuations arc substituted into each other 
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li- = 0.294i«7 ~l-72S.vlO \/vv — 6.067.vlU — 3.S73.vlO ^u^ob —O.Q\2SO (5) 



q = l.SS4.vKr^nv -6.365.\l(r^«/ -1.465.vl0"^<^^5 +3.\9}.xW~^u^bb +2.522.\\O~^0{6) 

These two equations describe the state variable representation of the 
linearized, vertical plane equations of motion. However they do not have the depth as 
a state variable. In order to make the depth a state variable, these equations are to be 
modified by using linearized auxilary equations which are given in Appendix C. There- 
fore the auxilary equation used Ibr the modification is 
i(, = —uSinO 4- vCosO sin 0 + vv cos 0 cos 0 
Using our assumptions the linearized equation will be 

Zq = —u 6 + w 

1 hen the modilied linear equations of motion have the following form 

z = -l.728.vKr- i/z -0.106u<j + (0.01283 -1.72S.vlO"^r^ -6.667.vloA^()s 
-3.SlxxnrW)b 

q = 1.884.vK:r^rz -6.365.y10'’»(/ -1.465.v10"^m^(5s +3. 193.vlO"VdZ; 

( S) 

+ (1.884.vlO“^/^ -2.522.vKr^)f? 



As it was mentioned before the forward speed u is not a state variable but 
a constant which can be changed as desired. A complete block diagram for vertical mo- 
tion is given in Figure 2. 

1). Linearization on the Horizontal Plane 

The linearized form of the equations on horizontal plane are: 

1) Equation of motion along y-axis (Lateral Force); 

/;iv - mar = -j l\ }>'• 4- -f -j l\ ]\.v 4- )\ur + YpUp) 

4- ■— Fv!U' 4- ) ^fSr) 

Using same set of numbers and hydrodynamic coelTicients, the final form 
of the equation is 

V = 1 . 89 /- - (3.30 - U. 291 IO- - 0 M 5 up - 2 . 563 .vlU*^n- + 7 . 568 .vlO"^r^( 5 r ( 10 ) 
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riguie 2. Block Diagiani for the Lincaiized Model on the ^'eltical Plane 



/j’ = + "T + ^r‘^’' + ^’v'’) + 'T + Bz^ii (11] 



‘1 he final form of the equation is 

p = -0.679f - 0.0584i- - 8.179.vKr\//> - 9.347jd0"^/r -3.942.Yl(r‘‘m- 

52 (' 2 ) 
+ 3. 942.vl0 i/^()r- 0.2360 

3) Equation of motion about z-axis ( Yawing Moment) 
hr = -y /^(A/ + A^,/’) + -y l^{?\p(r + BpUp 4- A^.v) + (13) 

The final form of the equation is 

r = -6.553.vl0”V’ + 6.767;rlO'‘‘v - 6.767 .y10’^/i- -4.51 l.r 10'^/;> - 4.076.vl0“^m^ 
-1.631.vKrVth- 

These three equations are supposed to describe a submerged submarine 
motion in the horizontal plane. '1 he only difference from the equations for vertical mo- 
tion is the equations for the horizontal motion have the order of the highest derivative 
of all the variables such as v, p and r in each particular equation. [Ref 4: p. 48] 

1 laving all of the highest derivatives in each particular equation creates 
an algebraic loop problem for the simulation. To solve this problem it is possible to 
manipulate the equations to eliminate the highest order derivative from one of the 
equations which includes the other derivative as it was done before for the vertical plane 
equations of motion. 1 his was done very nicely for the case of two equations but does 
not seem to be very attractive when there are three or more equations involved. 

There are some other possible ways to solve algebraic loop problems. But 
since the new version of DSL [Ref 5] can take care of this problem automatically, it is 
preferred to use those equations in simulation. 

A complete block diagram for horizontal motion is given in Figure 3. 
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rigure 3. Block Diagram for (he Linearized Model on the Iloiizontal Plane 



10 



C. VALIDATION OF LINEAR MODEL 



The objective of this section is to compare the dynamics of the standard model with 
the derived linear model in both vertical and horizontal planes. 

In order to compare both models they should be in the same initial state and both 
models have to be in trim. In trim has the meaning that the submarine maintains depth 
at a given speed with the desired pitch angle without using bow or stern planes. When 
making linearizing assumptions the terms which are related to trim are already ignored. 
Therefore the linearized model will be in trim at all times. Because of the submarine hull 
and sail structure it is required to adjust ballast tanks for given speed. The corrections 
for trim which are used in the simulation for this study are obtained from an earlier 
thesis study. [Ref 6: p. 184] 

'fo validate the linear model it is preferred to obtain both the initial condition and 
forced response in order to make sure that the linear model is working properly. 

1. \ aIicla(ioii of Linear Model on \ erlical Plane 

a. Initial Coiulition Response 

It was expected that for small perturbations the deviations between models 
should be small. Therelbre initial conditions of 5° in pitch were tested first. For the linear 
model it is also required to give an initial value for depth change which was defined as: 
z = -uSin 0 

Test runs up to 360 sec. in the speed range 5 to 25 Knots were performed 
simultaneously for both models. Maximum dilferences for each run were obtained from 
data files and given in Table I. The pitch and depth behaviors for both models were 
given in Fig. 4-8. 



Table I. INITIAL CONDITION RESPONSE TO 5 DEGREE PITCH ANGLE 



Run 

No. 


Speed 

(,Kts.) 


.Maximum Deviation In 


rig. 


Pitch 


Z 


Depth 


Deg. 


0 

0 


Ft. see. 


To 


Feet 


"^0 


1 


5 


0.0901 


1.8 


0.()017 


0.2 


0.1050 


0.1 


4 


2 


8 


0.0608 


1.2 


0.069 


0.6 


0.6740 


0.7 


5 




12 


U.0?02 


n.6 


0.0 1 13 


0.6 


1 .0960 


I.l 


6 


4 


18 


0.0486 


1.0 


0.0275 


1.0 


3.4200 


1.4 


7 


5 


25 


0.1908 


3.8 


0.1569 


4.3 


1 1.960 


4.8 


8 



II 



As can be easily seen from the figures and fable 1 all deviations are very 
small for this initial condition, 'fhat means dynamics for both model are nearly identical 
for small perturbations. 

In normal operational conditions a submarine never exceeds 20° pitch an- 
gle. But theoretically maximum allowed pitch angle is limited to about 45°. Therefore 
three more runs were performed with 45° initial pitch to see large perturbation elfects 
on system dynamics. Simulation results for 45° initial pitch angle are given on Figures 
9-11. Maximum deviations for pitch angle, speed in the z direction and depth are given 
in Table 2. .Maximum deviation does not exceed 7'To for this case as can be seen in Table 
2 . 



Table 2. INITIAL CONDITION RESPONSE TO 45 DEGREE PITCH ANGLE 



Run 

No. 


Speed 

(Kts.) 


.Maximum Deviation In 




Pitch 


z 


Depth 


Fig. 


Deg. 


% 


Ft., sec. 


•lo 


Feet 






6 


5 


0.8449 


1.9 


0.240S 


4.0 


18.470 


3.7 


9 


7 


8 


I.I988 


2.7 


0.1997 


2.1 


9.690 


1.9 


10 


8 


12 


2.480 


5.5 


0.9700 


0.8 


05.260 


6.5 
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'fhe deviations between both models for a second set of initial conditions 
are much bigger but still leads to very similar dynamic behavior. This was expected as 
the angle approximation 



sin B = 0 (1 5j 

is not as valid as lor 5° initial pitch angle. In general for both sets of initial conditions 
it is obsersed that increasing speed tends to increase the deviations between trajectories. 
b. Forced Response 

Both stern and bow planes can be used iir dilfercnt combinations to keep 
the ordered depth and pitch angle. In order to validate the linear model it is required to 
include some control plane commands in the simulation. Since the mechanical limit for 
the planes is about 35°, test runs were performed up to this angle. It is also desired to 
keep the submarine in maximum allowed pitch and depth limits. For the simulation runs 
which are pei formed only with bow plane, 5. 15 and 35 degree plane angles were applied 
after the first ten seconds. 
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IN. COND. RESPONSE FOR DEPTH U = 5KT5. 




IN. COfJD. RESPONSE FOR PITCH U = 5KTS. 




I riguie 4, Initial Conditiun Response Init. Pitch =5 Deg, U=5 Kls. 

i 

'j 
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IN. COND. RESPONSE FOR DEPTH U = 8KTS. 




IN. COND. RESPONSE FOR PITCH U = 8KTS. 




Fi^uie 5. Iiiilial Comlilioii Response Inh. Pi(cli=5 Deg. U=8 K(s. 
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IN. COND. RESPONSE FOR DEPTH U = 12KTS. 




IN. COND. RESPONSE FOR FITCH U = 12KTS. 




Figure 6. Initial Comlilion Response Init. Pitch =5 Deg. U= 12 Kts. 
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IN. COND. RESPONSE FDR DEPTH U = 18 KT5. 




IN. COND. RESPONSE FOR PITCH U = IB KT5. 




Figure 7. Initial Condition Response Init. Pitcli=5 Deg. U= 18 Kts. 
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IN. COND. RESPONSE FOR DEPTH 



U = 25 KTS. 




IN. COND. RESPONSE FOR PITCH U = 25 KTS. 




Figure 8. Initial Condition Response Init. Filch =5 Deg. U=25 Kts. 
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IN. COND. RESPONSE FOR DEPTH U = 5 KTS. 




IN. COND. RESPONSE FOR PITCH U = 5 KTS. 




Figure 9. Initial Coiulition Resi)ousc Iiiit. Pitcli = 45 Deg. U=5 Kts. 



IS 



IN. COND. RESPONSE FOR DEPTH U = 8 KTS. 




TIME(5EC.) 



IN. COND. RESPONSE FOR PITCH U = 8 KTS. 




Figure 10. Initi.il Coiulition Response Iiiit. Pitcli = ‘45 Deg. U = 8 Ivts. 
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IN. COND. RESPONSE FOR DEPTH U = 12 KTS. 



o 




IN. COND. RESPONSE FOR PITCH U = 12 KTS. 




Figmc II. Iiiilial Coiulilioii !U*S])oiise Iiiit. Pilch = 45 Deg. U= 12 Kls. 
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Because of the enormous eHecl of the stern plane on submarine pitch angle, 
it was concluded to use reverse angles for 30 seconds each and then to bring the stern 
plane to the neutral condition. 

Maximum deviations were obtained from data files by a FOR I 10\N pro- 
gram and given in Table 3, 4 and 5 for bow planes, stern planes and both planes re- 
spectively. 

The test simulation results which were obtained with the bow planes, are 
given in Figures 12 through 20. Figures 12, 15 and IS represent small perturbations for 
three different speeds and it can also be observed from 'fable 3 that maximum deviation 
is not more than 23 ft. for depth and not more than 0.4 degree for pitch angle. Figures 
13, 16 and 19 were given for 15 degree bow plane and except for Figure 19 which re- 
presents the simulation with IS Kts. forward speed, the linear model is acceptable. For 
35 degree bow planes, the linear model is valid only for lower speeds as can be seen from 
Figures 14. 1 7 and 20. 



Table 3. FORCED RESPONSE TO BOW PLANES 



Run 

No. 


Speed 

(Kts.) 


Bow 

Plane 

(Deg.) 


.Maximum Deviation In 


Fig. 


Pitch 


Z 


Depth 


Deg. 


r» 

'/ 0 


It., sec. 


'‘/o 


1 cot 




9 


5 


5 


0.0850 


19.8 


0.0046 


3.2 


1.420 


1.0 


12 


10 


5 


15 


0.3751 


29.2 


0.0 12S 


3.1 


0.500 


0.2 


13 


11 


s 


35 


1.4706 


08.2 


0.2285 


22.6 


58.980 


14.1 


14 


12 


12 


5 


0.3598 


35.6 


0. 1006 


19.0 


21.750 


11.5 


15 


13 


12 


15 


2.5177 


82.5 


U.6860 


43.2 


148.25 


33.1 


16 


14 


12 


35 


9.0961 


127.7 


1.966S 


53.1 


3S2.52 


40.4 


17 


15 


IS 


5 


0.4103 


19.0 


0.1743 


19.2 


23.650 


14.4 


IS 


16 


IS 


15 


5.1356 


79.3 


2.4369 


S9.7 


557.87 


103.7 


19 


17 


18 


35 


19.340 


128.0 


8.1425 


12S.5 


1852.8 


1 10.8 


20 
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DEPTH CHANGE WITH 5 DEGREE DOWN BOW PLANE 




PITCH ANGLE WITH 5 DEGREE DOWN BOW PLANE 




Fiyiire 12. 



Forced Response. 13on\ Plane = 5 Deg. doAMi. U = 5 KFs. 



DEPTH CHANGE WITH 15 DEGREE DOWN BOW PLANE 




PITCH ANGLE WITH 1 5 DEGREE DOWN BOW PLANE 




Figure 13. Forcetl Response. Bon ri.Tiie = 15 Deg. ilonn. U = 5 Kts. 
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FORCED RESPONSE WITH 35 DEG. BOW PUNE 





Figme M. forced Response. Don flaiie = 35 Deg. doun. U = 5 Kts. 
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FORCED RESPONSE WITH 5 DEG. DOWN BOW PUNE 





Figure 15. 



Forced Response. Bon Plane = 5 Deg. donn. U = 12 Kts. 



DEPTH (F 



FORCED RESPONSE WITH 15 DEG. DOWN BOW PUNE 




TIME (SEC.) 




Figure 16. Forced Response. Con Plane = 15 Deg. donn. U = 12 Kts. 
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FORCED RESPONSE WITH 35 DEG. DOWN BOW PLANE 





Figure 17. Forced Rcs|)onse. Bou Plane = 35 Deg. donn. U = 12 Kts. 
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FORCED RESPONSE WITH 5 DEG. DOWN BOW PLANE 




MONUNS*J7 MODEL 
UMEAR MODEL 




Figure 18. Forced Response. Don Plane = 5 Deg. donn. U = 18 Kts. 
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FORCED RESPON’SE WITH 15 DEG. DOWN BOW PLANE 





riguie 19. roiccti Response. Bow Tlniie = 15 Deg. do^ui. U = 18 Kls. 
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FORCED RESPONSE V/ITH 35 DEG. DOV/N BOW PLANE 
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ri”iiie 20. 1 Oiced Response. Ron Rlaiie = 35 Deg. donn. U = R( Kts 
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Therefoie the linear model is valid for all speeds for small plane angles. And 
in general, it is possible to say that for the first 120 seconds the linear model does work 
well enough for large perturbations. In lact it is not very often that a watch officer 
wants to keep the bow planes full down for more than 120 seconds in a real submarine. 

'1 he test run results which are obtained with stern plane, are given in Fig- 
ures 21 to 29 and Table 4. Similarly, deviations are acceptable for small and medium 
perturbations as can be seen from the figures. The only condition for which the linear 
model can not be accepted as valid, is displayed in Figure 29 which represents 35 degree 
bow planes with 18 Kts. forward speed. This is e.xpected since two important linearizing 
assumption are invalid at this speed and resulting pitch angles are large. As mentioned 
before, the constant speed assumption for large plane angles and the sin(x) = x ap- 
proximation for pitch angle are no longer valid for this run. 



Table 4. FORCED RESPONSE TO STERN PLANES 



Run 

No. 


Speed 

(Kts.) 


Stern 

Plane 

(Deg.) 


Maximum Deviation In 


Fig. 


Pitch 


Z 


Depth 


Deg. 


O e 
>0 


Ft. sec. 


Vo 


feet 


«/o 


18 


5 


5 


0.0910 


5.6 


0.0016 


1.2 


0.1030 


0.1 


21 


19 


5 


15 


0.1808 


3.8 


0.0126 


3.3 


0.7400 


0.7 


22 


20 


5 


35 


0.902 1 


8.2 


0.1463 


16.4 


4.66K.) 


3.8 


23 


21 


12 


5 


0.3673 


5.6 


0.1070 


6.0 


5.000 


3.0 


24 


22 


12 


15 


2.5750 


13.1 


0.8569 


15.9 


35.680 


12.1 


25 


23 


12 


35 


12.010 


26.1 


5.2815 


42.1 


185.53 


33.5 


26 


24 


18 


5 


1.5585 


12.6 


0.7962 


14.2 


59.406 


19.0 


27 


25 


18 


15 


8.4160 


22.6 


4.8350 


28.8 


201.84 


27.4 


28 


26 


18 


35 


33.619 


38.8 


23.068 


58.8 


844.42 


53.3 


29 



fo be able to observe the elTects of both planes on deviations between 
models, nine more runs were performed using stern and bow planes simultaneously. For 
each run the same bow and stern plane angles were applied in such a manner so they 
can suppress each other's elfcct in order not to exceed submarine depth and pitch 
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FORCED RESPONSE WITH 5 DEG. STERN PLANE 





rigiiic 21. rorccd Response. Stern Plane = 5 Deg. U = 5 Kts. 



32 



PITCH (DECHEES) CEFTri (FEET) 

-202 ICO 104 1C3 




FORCED RESPONSE WITH 15 DEG. STERN PLANE 





I 

rigiiie 22 . I'oiccd Response. Stern Plnno = 15 Deg. U = 5 Kis. 
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FORCED RESPONSE WITH 35 DEG. STERN PLANE 





riguie 23. rorctcl Response. Slciii Plane = 35 Deg. U = 5 Kls. 



34 



FORCED RESPONSE WITH 5 DEG. STERN PUNE 





rigiue 24 . rorccd Resi)onse. Slein Plnne = 5 Deg. U = 12 Kts. 



FORCED RESPONSE WITH 15 DEG. STERN P1j\NE 





rigiiie 25. foiccd Response. Stem Plane = 15 Deg. U = 12 Kts. 
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FORCED RESPONSE WITH 35 DEG. STERN PLANE 





Figure 20. Foiced Response. Stern Pl.nne = 35 Deg. U = 12 Kls. 
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FORCED RESPONSE WITH 5 DEG. STERN PUNE 





riyine 27. Fmced Response. Stern Plane = 5 Deg. U = 18 Kts. 
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FORCED RESPONSE WITH 1 5 DEG. STERN PLANE 





Figure 2G. Forced Response. Slern Plane = 15 Deg. U = 18 Kls. 
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FORCED RESPONSE WITH 35 DEG. STERN PLANE 





Figure 29. Forced Response. Stern Pl.nne = 35 Deg. U = 1<S Kts. 
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limitations. I'igures were created but not supplied in this study since they are very similar 
to the precceding results which were obtained using only stern planes. Deviations 
between models for this last set of runs ai e a little bit larger than the preceeding results. 
Using two sets of planes means more appro.ximations lor the linear model and greater 
deviations between linear and nonlinear models are expected. 



Table 5. FORCED RESPONSE TO BOW AND STERN PLANES 



Run 

No. 


Speed 

(Kts.) 


Bow 


.Maximum Deviation In 




& 

Stern 

Plane 


Pitch 


Z 


Depth 


Fig. 


Deg. 




Ft., 'sec. 


% 


Feet 


°/o 




27 


5 


5 


0.0943 


6.8 


0.0012 


1.1 


0.0500 


0.05 


- 


28 


5 


15 


0.2448 


6.0 


0.0262 


8.0 


0.9030 


0.8 


» 


29 


5 


35 


1.3542 


14.2 


0.2891 


37.7 


8.0200 


7.1 


- 


30 


12 


5 


0.5151 


8.4 


0.1558 


8.9 


7.2100 


4.4 


- 


31 


12 


15 


3.6320 


19.8 


1.3423 


25.6 


53.000 


18.3 


- 


32 


12 


35 


16.329 


38.2 


7.1826 


58.8 


262.15 


48.4 


- 


33 


18 


5 


2.01 17 


16.8 


1 .0424 


18.5 


61.856 


19.6 


- 


34 


18 


15 


11.203 


31.2 


6.6167 


39.1 


267.52 


35.8 


- 


35 


18 


35 


43.214 


51.6 


27.816 


70.4 


1053.8 


65.5 


- 



Obviously the linear model does not behave like the nonlinear model for 
large plane angles and high speeds. '1 he most important reason for this is the constant 
speed assumption for the linear model. This assumption is no longer valid for large plane 
angles since planes reduce the forward speed of the actual submarine. Since the aim of 
this study is to validate the linear model for small perturbations, it is achieved for the 
vertical plane. 



2. Validation of the Linear Model on the Horizontal Plane 

A submarine behaves like a surface ship for most horizontal motions. 'fhere are 
some din'erences because of its submerged condition and sail structure, 'fhe main dilfer- 
ence is in roll. A submarine rolls to inboard when a rudder angle is applied. Also the 
rudder has a squatting efl'ect on the submarine which makes the submarine to pitch up 
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and di\c. Since tlic linear model assumes that there is no cross-coiiplins: between \ertical 
and horizontal motion it is not possible to compare the squatting cll'cct with the linear 
model. 

On the horizontal plane, roll and yaw angles and sway speed can be observed. 
Roll and yaw inCormation are displayed on figures and tables for convenience. But the 
sway response is only supplied on tables as deviation between models. 
a. Initial Condition Response 

'I'he simulations were carried out with a certain roll angle as initial condi- 
tion. In order to sec the small and large perturbations effects, 5 and 25 degrees initial roll 
angles were chosen and test runs were performed at 5, 8. 12, 18 and 25 Kts. 

Since both models reach a steady state value after about l2o seconds, sim- 
ulations up to 120 seconds were performed, simultaneously for both the linear and non- 
linear models. Maximum deviations for each run were obtained from data files and are 
given in fable 6. 



Table 6. INITIAL CONDITION RESPONSE FOR HORIZONTAL PLANE 



Run No. 


Speed 

(Kts.) 


.Ma.ximtim Deviation In Roll 


figures 


Init. Rolf 


= 5 Deg. 


Init. Roll = 


= 25 Deg. 


Degree 


3 0 


Degree 


I'l 

o 


3b-37 


5 


0.0972 


1.9 


3.2242 


12.9 


3H-32 


3vS-39 


8 


0.0677 


1.3 


2.0457 


8.2 


3n-33 


40-41 


12 


n.0365 


0.7 


1.34*10 


5.4 


31-33 


42-43 


18 


0.0.342 


0.7 


1.1720 


4.7 


31-34 


44-45 


25 


0.0252 


0.5 


1.0160 


4.1 


32-34 



As can be seen from figures 30. 31 and 32. it is obvious that there is almost 
no deviation on roll response for 5 degree initial roll angle. There are some slight devi- 
ations lor 25 degree initial roll angle and unlike the vertical plane, deviations arc de- 
creasing with increasing a.xial speed. It is to be noted that the approximation by a linear 
mode! has not alfccted the period of rolling. Simulation results arc given on figuies 32, 
33 and 34 for 25 degree initial roll angle response. 

Iheielore it has been concluded that the linear model on hoii/ontal plane 
is valid lor smtill and large initial conditions. 
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INIT. CONO. RESPONSE - INIT. ROLL = 5 DEG 





Figure 30. Initial Condition Response Init. Roll=5 Deg. U= 5 and 8 Kts. 
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INIT. COND. RESPONSE - INIT. ROLL = 5 DEG 





Fiyiire 31. Inilial Coiulifion Response Ini(. Roll=5 Dcj;. U== 12 anil 18 K)s. 
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INIT. COND. RESPONSE - INIT. ROLL = 5 DEG 




INIT. COND. RESPONSE - INIT. ROLL = 25 DEG 




Figure 32. Init. Cond. Response Init. Roll =5 and 25 Deg. U= 25 and 5 K(s. 
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INIT. COND. RESPONSE - INIT. ROLL = 25 DEG 





Figure 33. Initial Condition Response Init. Roll = 25 Deg. U= 8 and 12 Kts. 
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INIT. COND. RESPONSE - INIT. ROLL = 25 DEG 





Figiiie 34. Initial Condition Response Init. Roll = 25 Deg. U= 18 and 25 Kts. 
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b. Forced Response 

The only relevant force beside propellers is created by the rudder on hori- 
zontal plane. The rudder also has an appreciable eflcct on vertical motion which is called 
the stiuatting effect. I:\cn though the linear model assumes tliat there is no cross- 
coupling effect between vertical and horizontal motion, it was decided to display depth 
and pitch angle changes which were obtained by non-linear simulation for further study. 
Cross-coupling effects which are obtained by non-linear simulation at different speeds, 
are given in Figures 38, 40, 42, 44, 46, 48 and 50. 

Simulation runs are abtained for three difl'erent speeds and rudder angles for 
this case. Plots for yaw and roll response are given in Figures 35-37, 30, 41, 43, 45, 47 
and 49. Maximum deviations are given on Table 7. Again similar deviation behaviors 
can be observed as veitieal motion. 



Table 7. FORCED RESPONSE TO RUDDER 



Run 

No. 


S|’>eed 

(Kts.) 


Rudder 

(Deg.) 


.Maximum Deviation In 


I'ig. 


V 


^'aw 


Roll 


Ft'see. 


To 


Deg. 


'Vo 


Deg. 


"o 


46 


5 


5 


0.O060 


3.6 


0.3775 


13.7 


0.004 1 


3.0 


35 


47 


5 


15 


0.0487 


9.8 


2.0360 


24.7 


0.0518 


12.7 


36 


48 


5 


35 


0.2413 


20.8 


3.3520 


17.4 


0.3633 


38.3 


37 


49 


12 


5 


0.1417 


14.9 


2.8058 


23.8 


0.2880 


18.6 


38 


50 


12 


15 


0.9515 


33.6 


13.27 


37.5 


2.6034 


56.0 


39 


51 


12 


35 


3.7804 


57.2 


42.223 


51.1 


10.345 


95.4 


40 


52 


18 


5 


.0.5104 


25.3 


6.97 


30.3 


1.6658 


35.0 


41 


53 


18 


15 


3.0963 


51.2 


35.065 


50.8 


11.262 


78.9 


42 


54 


18 


35 


10.424 


73.8 


106.83 


66.4 


34. .>25 


103.6 


43 



As a result of this chapter it has been concluded that approximation by 
linear model is valid for small perturbations at all speeds for both motions. In addition, 
it has been observed that tlie linearized model is still valid for large perturbations applied 
over a short period of time. 
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FORCED RESPONSE WITH 5 DEG. RUDDER 





riyime 35. Forced Response. Rudder = 5 Deg. U = 5 Kts. 
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FORCED RESPONSE WITH 15 DEG. RUDDER 





Figure 36. Foiced Res|)OMse. Rudder = 15 Deg. U = 5 K(s. 
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FORCED RESPONSE WITH 35 DEG. RUDDER 





Figure 37. Forced Response. Rudder = 35 Deg. U = 5 Kts. 
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FORCED RESPONSE WITH 35 DEG. RUDDER 





ri<;iiie 38. Cross-Coupling Elicct on Vertical Plane. Rudder=35 Deg. U=5 Kts. 
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FORCED RESPONSE WITH 5 DEG. RUDDER 





rignre 39. 



Forced Response. Rmldcr = 5 Deg. LI = 12 K(s. 



PITCH (DECREES) DEPTH (FEET) 

2 . 0.4 0.6 O.a 475 480 485 490 495 500 



FORCED RESPONSE WITH 5 DEG. RUDDER 





rij;uie 40. Cross-Coupling Effect on Vertical Plane. Ru(Uler=5 Deg. Ci= 12 Kis. 
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FORCED RESPONSE V/ITH 15 DEG. RUDDER 





rigiiie 41. Forccil Response. Rmldcr = 15 Deg. do>»ii. U = 12 Kis. 
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Figure 42. Cross-Coupling Ofect on Vertical Plane. Rn(ldei~ 15 Deg. U= 12 Kts. 



56 



FORCED RESPONSE WITH 35 DEG. RUDDER 





Figure 43. Forced Response. Rudder = 35 Deg. U = 12 K(s. 
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FORCED RESPONSE WITH 35 DEG. RUDDER 
AXIAL SPEED U = 1 2 KTS. 
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Figure 4-1. Cross-Cou|)ling Effect on Vertical Plane. Rudder=35 Deg. U= 12 Kts. 
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FORCED RESPONSE WITH 5 DEG. RUDDER 





ri^uiTP Forced Response. Rudder = 5 Deg. U = 18 Kls. 
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FORCED RESPONSE WITH 5 DEG. RUDDER 





Figure 46. Cross-Coupling Elfect on Vertical Plane. Rut]iler=.S Oeg. U= IS Kts. 
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FORCED RESPONSE V/ITH 15 DEG. RUDDER 





rigiiie 47. Foiccd Kcspoiisc. Fliulticr = 15 Ucg. U = 18 Kts. 
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FORCED RESPONSE WITH 15 DEG. RUDDER 





Figure 4S. Cross-Coupling Eliect on Vertical Plane. Rudder = 15 Deg. U= 18 Kls. 



62 



1 



I 

I 




VoV 

X^oovt_»^^ 



FORCED RESPONSE WITH 35 DEG. RUDDER 





Figure 49. Forced Response. Rudder = 35 Deg. U = 18 Kts. 
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FORCED RESPONSE WITH 35 DEG. RUDDER 
AXIAL SPEED U = 1 8 KTS. 
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Figure 50. Cross-Coupling Effect on Vertical Plane. Rudder = 35 Deg. U= 18 Kts. 
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m. AUTOMATIC DEPTH AND PUCII CONTROL 

A. DESIGN SPECinCAI lONS 

After a valid linear model is defined, any type of design method I'or linear systems 
can be ii';ed. It is assumed that the submarine which is considered in this study has no 
inertial guidance system, 'fhat means rate information is not available and the only 
states to be used as feedback are depth, pitch and speed. Due to this limited instrumen- 
tation the controller will have to use cascaded filters. 

Since a submarine maneuvering capability depends highly on the axial speed, it is 
\ery hard to satisly some certain spccifieations foi' this kind of control systems. Hut 
basically it is acceptable if the control system can achieve 10 It. depth change in 120 
seconds and 100 ft. depth change in 240 seconds. Also more than 2 feet overshoot is not 
desirable for small depth changes and overshoot must stay within 5‘’i) for large depth 
changes. Deviation from ordered pitch must stay within 2 degrees. 

Tor the control system to be designed, plane angle limits which arc about ,vS degrees, 
have to be taken into the consideration. A depth and pitch control system which retiuircs 
more th;m .^5 degrees plane angles to get the ordered depth or pitch is clearly not 
realizable. 

B. DESIGN 

1 he linearized cipiations of motion for the vertical plane arc obttiincd and given in 
Chapter 2. I hey arc repeated below for convenience 

z = -1.728.vl(r-’,/i -QjiKmq + (0.01283 -1.728.V -6.667.vl()-^„^>.s 

4 ■> ( 10 ) 
-3.873.vlO ^ 

q = 1.884.vl0”-'//z -6365.x W~\iq- 1 .465.x\0~^?ds -f3.193.vlO"'\/C)/) 

-S 2 3 (17) 

+ (l.884.vlO ■// -2.522.vlO~^)d 

A signal flow graph can describe the corresponding input output relations for these 
equations. Inputs will be the bow and stern plane angles and outputs of interest arc 
depth and pitch for vertical motion and such a flow graph is given in Tig. .31 where 
(7 = -3.87.vlO 
h = -l.73.vIO -'ll 
c = -|.465.vlO 
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Figure 51. Sigii.il Flow Graph for Vertical Equations of Motion 



(i = — 6.67.yI 0 ‘’n* 
e = 3.19.rlO 
y = —().36.vl <.)’;/ 
g= l.88.vIO-'i/^-2.52.rI()-5 
h = O.HXm 

,• = 0.013 - 1.73.vlO-’»' 
k= \.SS.x\i)-'-u 
1 . Decoupling 

In order to design a cascade compensator with a single loop technique, one must 
have the independent input-output relations for each input and output [Ref. 7 ]. In 
other words it is necessary to obtain two transfer functions for depth and two transfer 
functions for pitch which have the stern and bow planes as inputs. 

Applying Mason's gain rule to the signal How graph given in Fig.44 the input- 
output relations will be as follows [Ref. 8: p. 83J. 
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depth 


it^^ ^ {eh — af)s 4-r/ — ag 


(K8) 


dh 


.e — (/'+ b}s^ + {bf — g — kh).e + (gb — ki)s 


depth 


d.e + (eh — df)s +e.i — dg 


(19) 


Os 


/ — (/+ b).C + (bf— g — 'kh).e + [gb — ki)s 


pitch 


cs — be + ak 


(20) 


oh 


— [f + b)s^ + (bf— g — kh)s + (gb — ki) 



/’'/<■/' cs - Ac + lik 

— if + h)si~ + {bf— g — kh)s + {gb — ki) 



( 21 ) 



Substituting the concsponcling numbers into these equations 

(brill _ -2.i.vKr^/^s - 9.33.vio~^/^ +i.7.\vnr°?/ 

+8.09.V + (2.52.vl(r^ -2.1 l.vK^^/^).s^ +4. 1 2.r|(r''’/,,9 

depth ^ -6.67.vl0~^f^5^ -6■l■vl(^^/^s - 1.87.vlO~^/^ +3■78■vl<^^/^ 

s'* +S.09.vl()~^t/s^ + (2.52.x'lU~^ —2.1 l.vlO~^ir)s^ 4 4. 1 2.vl(r*’n5 



(22) 



(2.-^) 



pitch 

dh 



.8.19.vl(rV5-1.75.vl(rV 



5* +8.()9.vKr^/s^ + (2.52.Yl(r* -2. 1 l.vl(.r^/^).s +4.12.vl(^^ 



(24) 



rbi'h -1.46,^vl(^^^^ls-l.28■vlO~^/* 

s'* +S.09.rl()~^»5^ + (2.52.vIU~^ —2.1 l.vlU~^;/^).s +4. 12.vl(r'’// 



(25) 



Transfer functions which arc dealing with depth, have fourti) order characteristic 
equations and they are type one systems with the same denominator. On the other h;md, 
transfer functions for pitch arc type zero and have third order cliaraciciistic ccjuations 
with the same denominator. Also all transl'er functions have the same i^olcs except one 
at the origin. So it is expected that they might show similar Irctiuency rc'^pon'^c and it 
may be possible to use only one cascade compensator to compansatc the whole system. 

In order to make further analysis on these transfer functions, the axial speeil. u 
has to be defined as a number. It is always possible to design the control system (or a 
specific speed and check the validation of design for a certain speed range. Since slower 
speeds make it harder to get desired depth and pitch angle, it is not vciy cnicient to use 
an automatic control for less than 5 Knots. A possible approach would be to use 10 
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ft see. ( 5.9 Kts.) as axial .speed. If the designed control system works for this speed, it 
will probably work for the higher speeds. 

2. Design 

With 10 ft. 'sec. axial speed, transfer functions become 



dcpih 


-3.87.rlO“V -2.1.vKr''5- 9.33.vKr^ 


(26) 


Sb 


/ + 8 . 09 .v 10 ~^ 5 ’ + 0 . 41 .v 10 ”^ 5 ^ + 4 . 12 .v 10“^5 


depth 


— 6.67.vl0 ^5^ — 6.06.vl0 ^ 5 + 1.91.rl0 ^ 


(27) 


ds 


+8.09.vl0“V + 0 . 41 .v 10 ~^ 5 ^ + 4 . 12 .v 10"^5 


pitch 


3.19.vlO“^-1.75.vlO"® 


(28) 


Sb 


5^ + 8 . 09 .v 10 "^ 5 ^ + 0 . 4 Lv 10'^5 + 4 . 12 .v 10 ”^ 


pitch 


-1.465.vl0"^ -1. 28.x 10"^ 


(29) 


Os 


5 ^ +8.09.vl0"V +0.41.rl0"^5+4.12.vl0“-' 



It is more convenient to rename these transfer functions such as 



^iiU) = 

.?I2W = 

gni^) = 



depth 

Sb 

depth 

ds 

pitch 

Sb 

pitch 

Os 



1 hen the transfer function matrix becomes 



G(v) = 



?2lW ^22 W 



Using cascade compensation and a diagonal compensator matrix 

.?rllW 0 

Oi.s) = 

L ^ ^?C22(-^) 



(30) 

(31) 

(32) 



(33) 



(34) 



( 35 ) 
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riic corresponding control model is sketched in Fig. 52. 1 he equivalent transfer 
function matrix will be 









.?12(-5).<^c22(^) 

^22(-^X?c22(-^) 



(36) 



Characteristic equation roots for these transfer functions arc given in Table 8. 
Only one transfer function has roots in right half plane which is gi:(.s). 



Table 8. CHARACTERISTIC EQUATION ROOTS FOR VERTICAL MOTION 



Transfer Function 


Roots 




-0.392 ± jO.188. -0.001 + j0.045 


gnis) 


-0.030 + j0.260, -0.0646, 0.043 




-0.014 ± j0.022, -0.078 


g22U) 


-O.OOS + j0.02S, -0.065 



The open loop Bode diagrams and root locus plots arc given on Figures 53 to 
60. As expected transfer functions for depth have similar frequency response with a small 
positive phase margin. .Also both of them have root locations on the right half plane. 
On the other hand transfer functions for pitch show similar behavior, fhey arc also 
stable with 50 and 60 degrees phase margin. 1 he only transfer function which is stable 
for all gains is g,:(.s) as can be seen from Fig. 60. 

From the root locus diagrams one can easily see that, except for the other 
three transfer functions have many root locations on the right half plane which might 
make the cascade compensation design rcciuircd. Since gi 2 (.s) has characteristic ecpiation 
roots in the right half plane and also the root locus diagram shows one root location 
branch that extends along the positive real axis, it is clearly unstable. In particular 
gj 2 (s) might not need any compensation other than a gain adjustment. 

The elfect of bow planes on pitch angle and the elTect of stern planes on depth 
arc rather small compared to the elfect of bow planes on depth and stern planes on 
pitch. So it is considered best to focus on the transfer functions ,Cn(.s) and g ,2 while car- 
rying out a design procedure. Even if the designed compensators for these two transfer 
functions arc not satisfactory for the other two equations, the total system respoitse 
might be sufficient. 
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Figure 52. Cascade Compensated Control Model for Vertical Motion 



Since the transfer functions for the vertical plane have poles in the right half 
plane, they do’ not represent mininuiin phase systems. For a non-minimum pliase system 
it is more complicated to achieve a design which meets the required specifications. 
However it is possible to start with a very basic design and improve it after observing 
compensator effects on the system behavior. 

From the requirements mentioned before, the settling time will be more than 
100 seconds and the damping coelFicicnt [ is about 0.5 for sulFicicnt damping. Using the 
formula for second order approximation 



Ts = 



_ 4 _ 



(37) 



Solving for in, and substituting numbers 



0.5-tIOU 



= 0.08 



(38) 



1 he gain crossover frequency for the uncompensated system is about 0.2 
rad, 'sec. as can be seen from Fig. 54. Then the gain which is to be used for tlic first 
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Figure 54. Open Loop Bode Plot for . 
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Figiire 57. Root Locus Plot for .?:i(5) . 
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Figure 59. Root Locus Plot for g::{s) . 
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compensator, has to be less tlian one in order to get tlic desired l esiionsc. I his gain 
constant is called K1 and taken as 0.1 for the first trial. 

In order to increase phase margin a first order lead compensator is to be added 
to the forward path. Such a compensator has the form 



r (■'^ + 7 ) 

^ (5 + />) 



(•>0) 




The multiplier p z is required to keep error coeHicient constant. [Ref 2 | 

L'sing cascade compensator design techniques the best choice for the first trial 
on g .,,1 will be 



1 .s + 0. 1 m + 0.1) 

“ 0.1 .S+ 1.0 “ ^ 5 + 1.0 



(40) 



.Multiplying with K1 the total compensator is 



Gc = 



■s + 0. 1 

5+ 1.0 



(4!) 



The root locus plot and open loop bode diagram for the compensated system 
are given on Fig. 61 and Fig. 62. Ihe compensated system has about 75 degree phase 
margin which is obviously more than the specified requirements, 'fhis c.xccss phase 
margin may cause a request for the large plane angles which it is not possible to supply. 
Since it is always possible to use limiters on plane angles it is concluded to leave the 
designed compensator as it is and use it for preliminary design j'lrocedures. 

Since g;:(.s) is already very reasonable well damped, no compensator will be used 
and K2 will be taken as Ft) for the fust trial. 

I he next step is to put the compensator in the actual linear system and observe 
the response of the system. But before doing that the simulation program has to be up- 
dated in order to get more realistic results and accuracy. 
a. Limiters 

fhe mechanical liivut for both plane dellections is 35 degree. But it is not 
desirable to use full plane angles for higher speeds. v\lso it is possible to limit planes and 
the error signals, fhe test runs which arc achieved with limited planes led to unaccepta- 
ble plane behavior such as very small deflections. Under these set of circumstances it 
was concluded to limit the error signal such as: 
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Root Locus Plot for . 
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Open Loop Bode I’lol for . 
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liin =35 when u < 15 I't/scc. 

lim =25 w licn 15 < u < 30 It see. 

liin = 15 when u > 30 It/scc. 

Obviously this limiter docs not have any cHect for less than 15 ft. depth 
changes where there is no need for a limiter. 
b. Actiiatovs 

The linearized model docs not include the dynamics of the plane actuators, 
which arc force and moment producers. The actuator dynamics were ignored in the 
model comparison part of this study. In order to have an accurate model for the design 
procedure, an actuator model has to be added to the system dynamics. Such an actuator 
model was developed by [Ref. 6 ] and represented as 



G 



act 



1 

s + 0.667 



H2) 



I he complete model which is used in the simulation program is given in Tig. 




rigtiic 63. Block Diagram for Conipeusaletl Linear Model in \'cr(ieal Motion 




3. Siimilntion 

1 he simulation program is written based on the discussed subjects above. 'I he 
first run was made with the preliminary design gains, poles and 7eros. Then required 
corrections were made in order to meet the design specifications. I he DSL simulation 
program with the linal parameters is given in Appendi.v IL 

Test run results which were achieved with dilferent sets of parameters are given 
in figures 64 to 74. fach run is explained briefly below: 

Run No. I: 

1 he simulation program was run with the first set of parameters for lo ft. depth 
change and 10 ft, sec. axial speed which is the lower limit for this compensation. With 
K1 = 0.1 the required bow plane angle was very large and overshoot was 25'’/(i. This run 
does not meet the specified requirements. 

Run No. 2: 

In order to get reasonable plane response it is decided to reduce K1 to the value 
of 0.01. fhis time the maximum bow plane dellection is 26 degree but the time required 
to reach 10 feet depth change is a little longer than the specification, fhis run is also 
discarded. 

Run No. .3: 

A third apitroach would be to change K1 to 0.()15. The result was (piite satis- 
factory except the 40 degree maximum bow plane angle. 1 he main reason for this larger 
plane request is the excess phase margin on the system. The one possible way to resluce 
phase margin is to shiit the cascade compensator one decade up in the frequency do- 
main. 

Run No. 4: 

Using the new compensator with one zero at 1.0 and one pole at 10. o. the results 
are satisfactory. As can be seen from ligure 66 the maximum required how plane angle 
is 10 degrees, the time to complete 10 ft. depth change is 78 sec. and the overshoot is 
l<)”o. '1 his excess o\eishoot is the payofT for reducing the phase margin but since it 
makes only one foot difference, it is acceptable. 

Run No. 5: 

It is desired to check the system response for large depth changes. The simu- 
lation program was run for a 100 ft. depth change. .Maximum required bow ]ilane angle 
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is 34 degrees ami overshoot is 5 %. At this point it seems that tlie eompensated linear 
model for depth control is acceptable. 

It is also required to check the pitch response of the system, 'l est runs were 
performed with zero depth and some certain pitch angle change. Because of the bow 
plane cfl'cct (which tries to keep the submarine at the same depth) there was a steady 
state error on pitch angle. Since this pitch error relates very closely to K2, it is concluded 
to increase K2 to 2.0. 

Runs No. 6 and 7: 

'fo make sure that there is no negative effect on depth behavior of the system 
created by the new K2 parameter, two more runs were achieved with K2= 2.0 for 10 and 
100 feet depth change. Since there was only a slight change on osershoot, the new K2 
value is accepted and used for further study. 

Run No. 8 

In order to check the pitch response of the compensated system, a -5 degree 
pitch command was ordered while the depth change command was zero. System has 
reached the ordered pitch angle in 46 seconds and because of the bow plane elfect. it 
settled on -4 degree. Increasing K2 might decrease this steady state error but at the same 
time it might create more overshoot and instability problems on depth behavior of the 
.system. Since a 1 degree error is in the specifications limits. K2 = 2.0 will be used for 
further study. 

Runs No- and 10: 

Ihe next step is to check the designed system for a certain range of speed, for 
13.2 ft., 'sec. ( 9 Kts. ) two runs were performed with 10 and 100 ft. dejnh change. As it 
can be seen from I'ig.s 69 and 70 there is 12"o overshoot for 10 ft. depth change and 3"o 
for loo ft. depth change. Increasing the speed has a positive ell'ect for large depth 
changes xvhile having a negative effect for small ones. 

Runs No. 1 1 and 12: 

I he axial speed was increased to 12 Kts. The system reaches the ordered depth 
in shorter time and has only 2 % overshoot for 100 ft. depth change. 

Runs No. 13 and 14; 

Two more test runs were performed with 18 Kts. axial speed. .As can be seen 
IVom rig.s 21 and 22 the compensated control model is still valid and, in fact, works 
better with only T’o overshoot for large depth change. 

rinally it is considered that the designed automatic control for the linearized 
vertical motion using cascade compensator design techniques is satisfactory and should 
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he clieckcd with actual non-linear model. Alter designing another cascade compensator 
lor the horizontal motion, both models will be checked in order to sec whether the ilcsign 
is completed or needs some alterations. 
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10 FT. DEPTH CHANGE U = 10 FT./SEC. 




K1=0.01 K2=1.0 




Figure 64. Compensated Sj stem Depth Response Z =0.1, P = 1.0 
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10 FT. DEPTH CHANGE U = 10 FT./SEC. 
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Figure 65. 



Compensated System Deptli Response K1 =0.015, K2 = 1.0 



PLANE DEFLECTIONS U = 10 FT./SEC. 




Z=1.0 P=10.0 




Figure 66. 



Plane Angle Deflections for first and second Compensator 
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100 FT. DEPTH CHANGE U = 10 FT./SEC. 




PLANE DEVIATIONS 




rigme 67. 



Compensated System Response to 100 ft. Depth Cliaiige 



ORDERED PfTCH = -5 DEGREE U = 10 R./SEC. 




PLANE DEVIATIONS 




rigme 68. 



Compensated System Pitcli Response for Commanded Pitcli =-5 Deg. 



10 FEET DEPTH CHANGE U = 9 ICTS. 
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Figine 69. 



Compcnsnietl System Response to 10 ft. Depth Chnnge IJ = 9 Kts. 



100 FEET DEPTH CHANGE U = 9 KTS. 
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Figiiic 70. 



Compcnsnted System Response to 100 It. Depth Change U = 9 Kts. 
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10 FEET DEPTH CHAMGE U = 12 KTS. 
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FiAUZ DEFLECTIONS 




rijjiirc 71. 



Compensated System Response to lU ft. Depth Change U= 12 Kts. 
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100 FEET DEPTH CHANGE U = 12 KTS. 




PLANE DEFLECTIONS 




Figure 72. 



Compensated System Response to 1 00 ft. Depth Change U= 12 Kts. 
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10 FEET DEPTH CHANGE U = 18 KTS. 




PLANE DEFLECTIONS 




rigiire 73. 



Coinpeiisaled System Response to 10 ft. Depth Ciiaiige U 



IS Kts. 



100 FEEJ DEPTH CHANGE U = IB KTS. 




PLANE DEFLECTIONS 




Figure 74. Compensated System Response to 100 ft. Deptli Change 



U= 18 Kts. 
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IV. AUTOMATIC STEERING CONTROL 



l uiniiig characteristics of a surfaced submarine are very similar to a surface ship. 
But tlie situation in tlie submerged position shows big difl’erences. Sail structuie can be 
considered the main dillerence and the main source of rolling. But roll control is not 
considered in this study since the main purpose was to control depth change which is 
caused by the rudder. 

In Chapter 2, three equations of motion were linearized and derived for the hori- 
zontal plane. Same equations will be used to design a steering control for a submerged 
submarine. But the algebraic loop problem has to be solved before using Mason's gain 
rule. 

Three linear equations for horizontal motion are 

V = 1 ,89/- - 63p - 0.291W/- - 0.035///» - 2.563.vl(r^/v -I- 7.56S.vl(r^/^)r (d.3) 

/, = -0.679/- - 0.0584f - 8. 1 79.vKr^/n - 9.347.vl0"^//- -3.942.r Kr^/v 

-.2 

-t- 3.942.YlO 'j/^()r-().23()0 

/ '■ = — C.553.vlO 4- 6.767.y10 ‘'y — 6.767.rl0~^f//' — 4.51 1.y10~^;//’ — 4.076.v10 ^uv 

Substituting the highest derivative terms into each equation and after a great deal 
of algebraic work. 



V = — 0.437;/r -I- 0.027;//’ — 5.06.V 10 + 6.49.vl0 — 2.3S9</) (46) 

/) = 0.0:i(//- - 9.8.y10"^;/> -3.384.vlO“^n• -f 1.249.vKr^;^>r - 0.378^/) (47) 

/■ = — 7.2.vlO -I- 7.8.y10 — 3.SS8.y10~^;/v’ — 1.595.vl0~^;/^<b' — 4.094.vl0~\/) (48) 

A. DESIGN SPECIFICATIONS 

In general, the required time to achieve a course change in a ship depends on 

1. fhe forward speed, 

2. 'fhe diircrcnce between previous and commanded course, 

3. Applied rudder angle, 

4. Rudder area. 
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5. The length and hull strueturc of the ship. 

The submerged condition is also a very important aspect since the required turning 
time is about three times greater for a submerged submarine than a surfaced one. fspe- 
cially at lower speeds, it is very hard to achieve the desired course for a submerged sub- 
marine. 

It is concluded that for the speeds which arc less then 10 Kts., a control system must 
achieve every 10 degrees course change in 30 seconds. This allows 9 minutes to complete 
a 180 degrees turn and it is very reasonable for a low speed submerged submarine. For 
higher speeds this time limit W'ould be 20 seconds. It is also considered that more than 
2.5 degrees overshoot is not acceptable. 

The mechanical limit angle for rudder is also 35 degree and has to be considered in 
the design process. 

B. DESIGN 

'fhe cascade compensation method will be used for the horizontal motion. Since the 
aim of this chapter is to design a basic steering control, the roll response will not be in- 
vestigated. The yaw response to the rudder is the only input-output relation of interest 
at this point. Figure 75 represents a control model for the horizontal motion. 

A signal flow graph is given on Fig. 76 for the linearized equations of horizontal 
motion. The corresponding numbers for symbols in the flow graph arc given below: 
a = 0.4 3 7n 
b = O.Ollii 
c = — 5.0-vlO”'’?/ 

</= 6.5.V10-V 
e = -2.39 
/=0.021« 
g = — 9.S.vlO 
h = — 3.4.vl0"’i/ 

/= 1.25.V10-V 
j = -0.37S 
k = -1.2x\0-b( 

/= -7.8.V10 0/ 

,„ = -3.9.vlO-h/ 
n = — l.G.vlO 0; 
o = -4.l.vl()-3 
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Figure 75. Cascnde Compensated Control Model for Horizontal Motion 




I. Decoupling 

Since this signal How grapli creates 13 loops to be handled, it is considered to 
take u as 10 ft. /sec. at the beginning of the calculation in order to reduce the amount 
of required algebraic work. 

Applying Mason's gain rule to the signal How graph given in Fig. 76, the input- 
output relation for yaw will be as follows 



_ -1.6.y10~^'^ -5.4.v10~^s^ -6.8.y10~^s - 6.5.vl0~^ 
s' -k 0.1755‘^-b0.38855-’-f0.022.s^-5.77.vl<r'i 



(49) 



In factorized form, the same equation will be 

, -1.6.vl0~'^(.s -b 0.1 176 -F /).6222)(.s -f 0.1 176 -j0.6222l(.s + 0.102) 

^ “ 5(5 -f 0.0587 + jO.(A52}{s + 0.0587 -j0.6152)(5 -1- 0.0602)(5 - 0.0025) 



As can be seen from the transfer function, there is a real pole in the right half 
plane which is very near to the origin, fhe characteristic etiuation roots arc 
-0.058+y0.615 
-0.O18+/0.020 
- 0.1 
- 0.022 
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Figure 76. Signal Flou Graph for Horizontal Equations of Motion 



The root locus plot and open loop Bode plot for are given in Fig.s 77 and 
78. 

The root locus plot shows that there is a very small gain range where the system is sta- 
ble. d he Bode plot also agrees that the system is unstable with 15 degrees negative phase 
margin and there really is a small gain range over which the system will be stable with 
a small damping. 

Since it is obvious that a gain adjustment will not be enough to get the desired 
response out ol' the system, the cascade compensation will he required. In order to 
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Open Loop Code Plot lor 
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increase phase margin a first order lead compensator is to be added to the forward patli. 
Using cascade compensator design techniques, the first trial would be 



■ 1 5 + (M)1 (5 + 0.01) 

0.01 5 + 0.1 5 + 0.1 



'fhere will be no gain adjusment at this point. 

The Bode plot for the compensated system is given in Fig. 79. The phase margin 
is 40 degrees and that is about the ma.xiinum phase which can be acquired with only one 
cascade compensator. The root locus plot shows that the compensator has moved a lot 
of root locations to the left half plane and it is given in Fig. 80. 

Since the root locus and Bode plots show very reasonable damping and stability, 
it is considered that the compensated system is ready for the simulation. The DSL sim- 
ulation program which is used for the validation of the linear model (Appendix E), is 
updated with the designed cascade compensator. 1 his program is given in Appendix G 
including rcciuired modifications. 

2. Sinnilation 

'fhc same plane actuators which were used for the stern and bow planes, are 
used for the rudder in the simulation program. But since the input is totally dilTerent, it 
is necessary to dcsisin a dilfcrent criteria for the limiter. The first run was made without 
j any limiter, then using trial and error, the best limiter choice is appeared to be: 

( lim =0.07U whenu < 12 Kts. 

I liin =0.05U when 12 < u < IS Kts. 

lim =0.035 when u > 18 Kts. 

The complete model which is used in the simulation program is given in Fig. 81. 

l est run results which were achieved with dilferent sets of speed and course, are 
given in Figures 82 to 90. The roll response is also given in order to make sure that 
submarine docs not exceed maximum allowable roll limits. Each run is explained brielly 
below': 

Run No. 1: 

Using 6 Kts. forward speed and 10 degrees course change, the maximum re- 

I 

I quired rudder angle was 82 degrees. Therefore it is necessary to use a limiter on the error 

signal. 



103 



+ 

(J1 

Od \ 

o -- 
\ — * 
2 O 
(H • 
>- + 
CO 

q: -- 
o o 

L_ 

I 

UCJ 
O CD 
O 

OQO 
bJ 
CL {— 
O CC 
o cn 
_1 z 

LJ 
2 CL 
LJ 51 
CL O 
O CJ 



3SyHd 




( 90 ) OOfUINOyW 



Figure 79. Open Loop Bode Plot for . 



104 



COMPENSRTED YflW/DR 
GC-5-^0. 01/5+0.1 



T>c sismt raw m 

«CTL rm imiiMrirT mn 

o.ilwooio 

>O.llS 2 OOO 0 

u 
u 

T>c siSTtn ffwcs m 

nx zEjracs cxccrr thc mimm 

m fc iM'iNiTf 

uta r«n iw«iinii rm 

- 0 .II 7 S 9 W 1 
- 0. 1 1 758999 
> 0.10199999 
- 0.01000000 



> 0.05099999 

> 0.05969999 

> 0.10000001 

•0.OSO2OO0I 

0. 00250000 

0.00000000 




V) 

X 

cc 

CD 

£ 









-0 






*<«*«■ ■ B 


) ■ ■ 


, m 




( 

» 

■ 


■ 

■ 

■ 














t 






■ 

■ 


p 

■ 


« 








) 

\ 










» 

k 


■ 

> 






) 

1 












• 

m 

m 

n 

» 

■ 

■ 






► 

1 












p 

■ 






> 

> 






fl 


r 




1 






> 

t 

) 










7^ 


1 


c! 


^ 



-0.200-0,175 -0.150 -0.125 -0.100 -0.075 -0,050 -0,025 0,000 0, 

RERL RXIS 



025 



Figure 80, Root Locus Plot lor 



105 




Figure 81. Block Diagram for Compensated Linear Model in Horizontal Motion 



Run No. 2: 

Using tlie limiter which was mentioned above and for 15 degrees course change, 
the ma.ximum required rudder was 33 degrees. It takes 46 second to get 15 degrees course 
alteration with only 2.530 overshoot. 

Run No. 3: 

This time the system is tested with the same speed for a 90 degree course change 
which is one of the commonly used conmiands in a submarine. It takes 214 sec. to ex- 
ecute this conunand which is in the specilicd limits. The overshoot is 1.53o and maxi- 
mum required rudder angle is also 33 degrees. 

Run No. 4: 

In order to get the speed range in which the compensated system stays in the 
required specifications, the forward speed is increased to 10 Kts. For a 15 degree course 
change the time to execute the command is 22 sec with 1.9 feet overshoot. 

Run No. 5: 

Tor 90 degrees course change with 10 Kts. forward speed the time to execute the 
connnand is 103 sec. with 1.53o overshoot. Maximum required rudder angle is still 33 
degrees. As can also be seen from Fig. 86 the maximum roll is about 3 degrees. 
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Runs No. 6 and 7; 

These runs were made with 15 Kts. forward speed for 15 and 90 degrees course 
changes. While the required time decreases with increasing speed, the overshoot in- 
creases. But the results arc still in the specification limit as can be seen from Fig.s 87 and 
88. The maximum roll angle is 5 degrees for 15 Kts. forward speed which is also rea- 
sonable. The maximum required rudder angle is 23 degrees for this case. 

Runs No. 8 and 9: 

These runs were made with 20 Kts. forward speed also dictated the speed range 
for the compensated system because it becomes too oscillatory after 20 Kts. which is not 
desirable. It is nccessarx’ to add another cascade compensator to the forward path in 
order to get enough damping for speeds higher than 20 Kts. It is to be noted that using 

a limiter also helps to keep the roll angles small. In this case the maximum rudder angle 

I is only 16 degrees because of the limiter cll'ect. With this limited rudder angle the maxi- 

I 

mum roll is only 8 degrees. Even though it is not intended to control the roll, the limiter 

I 

j supplies an indirect control on the roll response. 

Finally it is considered that the designed automatic control for the linearized 
horizontal motion using cascade compensator design techniques, is satisfactory for the 
speed range of 6 to 2U Kts. Ihis design should be checked in the actual non-linear sys- 

I tern. 

! 
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Yniv aiitl Roll Response (o 10 Degree Course Cliange. No Liiuiler 
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Figure 83. '\’au aiul Roll Response to 15 Degree Course Change. With Limiter 
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ORDERED YAW = 90 DEGREES - U = 6 KTS 
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rigme JI4. \;\\y and Roll Response lo 90 Degree Course Change. 1 1 ^ 6 Kts. 
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Figure 85. 



Ya\i ami Roll Response to 15 Degree Course Change. U = 10 Kls 



ORDERED YAW = 90 DEGREES 



U = 10 KTS 
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Figure 86. 



Yn^^ and Roll Response to 90 Degree Course Change. U = 10 Kts 




ORDERED YAW = 15 DEGREES - U = 15 KTS 
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ri”iire 87. and Roll Response to 15 Degree Course Cli.ange. U = 15 KIs. 
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ORDERED YAW = SO DEGREES - U = 15 KTS 
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Figuie 88. Yaw and Roll Response to 90 Degree Course Change. U = 15 Kts. 
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ORDERED YAW = 15 DEGREES - U = 20 KTS 
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Figure 89. 



Vaiv and Roll Response to 15 Degree Course Change. II = 20 K(s. 
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ORDERED YAW = 90 DEGREES - U = 20 KTS 
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V. VALIDATION OF THE COMPENSATED NON-LINEAll MODEL 



The mniii purpose of this study was to show that it is possible to de';ign a 
compensator based on the linearized version of a non-linear model and then to com- 
pensate the actual non-linear model with this designed compensator. In the previous 
chapters the rccpiired compensators were designed for the linear models on vertical and 
horizontal motions. These compensators had to be checked with the actual non-linear 
model to see that the system will really work with them. 

The complete DSL simulation program for the non-linear model was already written 
and used by Ref. 3 and Ref. 5. It is also used for this study to compare linearized models 
with the non-linear model. In order to check the validity of automatic control systems, 
the DSL simulation program is to be modified including the compensator and limiter 
algorithms in it. 'fhc modified version of the DSL program for the compensated non- 
linear model is given in Appendix I. 

A. SIMULATION 

For the test runs to check the designed compensators, the same limiter values are 
used. Since the actual and conmuuulcd velocities ( U and UC ) are two dilfercnt pa- 
rameters and U is always somewhat less then UC, it is concluded to take actual speed 
U as the parameter for the limiters. Ihis will give more accurate plane dcdcctions de- 
pending on actual Ibrwaid speed. 

T he non-linear simulation program was run at 6, 10, 12, 15 and 20 Kts. for various 
depth, pitch and yaw commands. A di\ing submarine can give hundreds of maneuvci 
variations in three dimensional motions. Since it is not possible to include all of them; 
only the most common commands and the commands which were used in ('haptcr 2.3 
and 4 arc included for comparison purposes. 

The trim values for the ordered speed arc carefully calculated from Ref. 5 and im- 
plemented in the non-linear model. 

Test run results which were achieved for dilfercnt sets of speeds and commands arc 
given in rigurcs 91 to 106. Each run is explained bi icily below: 

Runs No. 1-4: 

The simulation program was run for 10 and 100 ft. depth changes at 6 Kts. com- 
manded forward speed. As can he seen from Fig. 91 the non-linear model completes a 
10 ft. depth change 10 sec. after the linear model docs. It completes a l<>0 It. depth 
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cliangc 20 !^cc. alter tlic linear model and overshoots lor both case are on the specilica- 
tion limits. 1 here is also a 1 (t. steady state error for both cases. 

At the same speed the simulation program was run for 1,'> and 90 degree course 
changes. As can be seen from Fig. 92 the non-lincar model takes about 100 seconds to 
achieve a 15 degree course change with no overshoot and a slight undershoot. Also the 
rc(|uired time to make a 90 degree course change is more than 360 seconds Cor the non- 
linear model. I hese two case are also non-acceptable. 

The main reason for this failure is the decreasing forward speed due to the plane 
dellections. 1 he forward speed, depending on the amount of the rudder dellection. ac- 
tually drops up to 4 Kts. while achieving a course change maneuver. 'I he same thing also 
happens for a depth change maneuver due to the stern and bow planes, fhe 
compensators were designed for actual 6 Kts. and higher speeds and they do not meet 
the specillcations for less than 6 Kts. forward speed. 

Under these circumstances no more investigations were made at 6 Kts. At this point 
it is concluded to operate at 10 Kts. 

Runs No. 5-iS: 

As can be seen in Fig. 93 the non-linear model completes a 1<) ft. depth change in 
42 seconds with I ft. overshoot at 10 Kts. It completes a K^O ft. depth change in 106 
seconds with 3.5” o overshoot. These numbers satisfied the recpiired s|iccilications and 
they arc nearly the same as for the linear model with a little time lag. 

As can be seen in Fig. 94 the non-linear model makes a 15 degree course change in 
25 seconds with D.8 degree overshoot which is less than the linear case. For a 90 degree 
course cliange the time is 205 seconds with no overshoot. Again due to the rudder drag 
force, tlie time to reach the commanded course is much larger but more realistic than the 
linear case. Since the constant speed assumption which is used Ibr the linear model is 
no longer valid for large perturbations, this is really expected. On the other hand the 
designed eascade compensators can still control the actual non-linear system elfectivcly 
enough and in fact, with less overshoot which is very important from the point of this 
study. 

Runs No. 9-12: 

In order to have an idea about speed deviation due to the plane dellections. four 
runs were performed for 10 and 100 feet depth change and 15 and 9o degree course 
change at !<• Kts. As can be seen in Fig. 95 there is an appreciable dillerencc between 
the drag Ibices created by rudder and bow, stern planes. 1 his is expected sinec the rudder 
has a lot more surface than the other planes. For a 15 degree course change the lorward 




speed drops abruptly to 9.3 Kts. and goes back to it's original \ aluc in a relatively small 
time. I or a 90 degree course change, the forward speed drops up to 9 i-its. and stays al- 
most constant for about 150 seconds which is the greatest cause for the slower course 
change rate. 

Runs No. 13 and 14; 

Since the linear model assumes no cross-coupling between vertical and hori/ontal 
motion, these runs arc performed only for the non-linear model. Cross-coupling elfcets 
oti depth and pitch angle arc shown in Fig. 96 at 10 Kts. for 15 and 90 degree course 
change commands. For both commands, the submarine stays in the 5 feet depth and 2 
degrees pitch error limitations. 

Run No. 15: 

One of the most dillicult maneuver for a submarine is to change depth while 
achieving a course conunand. Results of such a maneuver arc given on 1 ig. 97 and Fig. 
9iS. A simulation run for simultaneous 90 degree course and 100 It. depth change com- 
mands. shows that the time to reach 90 degree course change is about 40 seconds longer 
than the usual condition but it docs not all'cct the depth change, llccausc of the rudder 
elfect only a small depth error apircars until the submarine settles on the desired course. 

As can be seen in Fig. 98 the non-linear submarine's roll and pitch responses arc 
somewhat non-regular but still in reasonable limits lor this ease. 1 he forward speed de- 
viation due to the plane drag forces is also given in Fig. 98. Speed drops up to 8.3 Kt<;. 
and this gi\cs an explanation for lower course change rate. 

As a result for this run. even though the designed control systems interact, they can 
work well simultaneously. 

Runs No. 1 6 and 17: 

In order to be able to compare fixed rudder elTects on depth and pitch angle, two 
simulations were performed for 15 degree and 35 degree lixcd rudder commands in the 
same fashion as in Chapter 4 at 12 Kts. For 15 degree rudder the pitch and depth errors 
stay in spccincd limits but for 35 degree rudder these errors arc not allowable. Simulation 
results for this ease arc given in Fig. 99. 

Runs No. 18 and 19: 

Figure 100 gives the simulation results for a 15 and a 90 degree course change at 15 
Kts. for both linear and the non-linear models. The yaw response for 15 degree course 
change is almost the same as the response for 10 Kts. with a little more overshoot and 
oscillation. On the other hand the non-linear model shows a better response with less 
overshoot for both eases. 
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Runs No. 20 and 21: 

Figure 101 gives the simulation results for a 10 and a 100 feet depth change at 15 
Kts. Surprisingly there is almost no difTcrence between linear and non-linear model for 
the 10 feet depth change. But for the 100 ft. depth change the non-linear model has a 
faster response than the linear model. This is unusual and created by dilferent limiter 
behaviors on bow planes at this specilk forward speed. 

Runs No. 22 and 23: 

In a real submarine a depth change conmiand usually comes with a pitch command 
in order to reduce the time to get the desired depth. Figure 102 gives the results of such 
a command for 100 feet depth change with 5 degree down pitch angle at 6 and 15 Kts. 
For both cases the submarine reaches the desired depth 35 seconds before the case for 
which no pitch command is given. But as a trade-olFthe overshoots are over lOI'o. Also 
the pitch command has to be reduced to zero before the desired depth is reached in order 
to avoid too much overshoot and a steady state error on depth. This is done 10 feet 
before the desired depth is reached, for 6 Kts and 50 feet before for 15 Kts. 

Runs No. 24 and '25: 

Ihnally the compensated non-linear system was checked at 20 Kts. For a 15 and a 
90 degree course change, the yaw responses of the compensated submarine are given in 
Fig. 103. Ojk'c again the non-linear model gives a better but slower response then the 
linear model. For the 15 degree course change the yaw responses of both models become 
too oscillatory due to the high speed. But the compensator still works well enough to 
control the submarine. 

Runs No. 26 and 27: 

Figure 104 gives the compensated submarine depth responses for a 10 and a 100 feet 
depth change at 20 Kts. There is a 0.8 feet steady state error for both cases which is 
created by the system dynamics due to the high speed. 1 he control system design is 
based on 10 ft., 'sec. ( 0 Kts.) forward speed. At 20 Kts. the transfer functions which 
describes the submarine dynamics might have very dilFerent characteristics. Conse- 
quently it is concluded that the upper speed limit for this design is 20 Kts. In fact, the 
control system works up to 25 Kts. without exceeding design specification limits. 

The compensated submarine pitch responses for the same runs are given in Fig. 105. 
’1 he linear and non-linear models show very similar pitch behavior and pitch angles do 
not exceed the given 2 degree limit even for this high speed. 

As a result of this chapter it has been shown that the designed automatic control 
system for the linearized model can also work effectively on the actual non-linear model. 
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10 FEEJ DEPTH CHANGE UC = 6 KTS. 




100 FT. DEPTH CHANGE UC = 6 KTS. 




Figure 91. 



Compensated Siibiiiariiie Depth Responses at 6 Kts 



15 DEG. COURSE CHANGE UC = 6 KTS. 




90 DEG. COURSE CHANGE UC = 6 KTS. 




Figure 92 



Compensated Submarine Yaw Responses at 6 Kts 



10 FT. DEPTH CHANGE UC = 10 KTS. 
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100 FT. OEPTH CHAfJGE UC = 10 KTS. 




rigiire 93. 



Coinpeiisnted Submniine Depth Responses at It) Kis. 
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15 DEG. COURSE CHANGE UC = 10 KTS. 




90 DEG. COURSE CHANGE UC = 10 KTS. 




rij^me 94. Compensated Siihrnaiine Van Responses at 10 Kts. 
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Figure 95. 



De\intions from the Commnmied Speed for Non-Lincnr Subninrine 



CROSS-COUPUNG EFFECT ON DEPTH UC = 10 KTS. 




CROSS-COUPLING EFFECT ON PITCH UC = 10 KTS. 




Figure 96. Cross-Coupling Effects for the Non-Linear Subinariiie at 10 Kfs. 
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YAW RESPONSE FOR 90 DEG. AND 100 FT. CHANGES 




DEPTH RESPONSE U = 10 KVS, 




Figure 97. Course ami Depth Change CommaiulecI at the Same l ime UC= It) KIs. 



ROLL AND PITCH RESPONSE UC = 10 <TS. 




FORWARD SPEED DEVIATION 




Figure 98. Roll. Pitch and Speed Response for Multi-Manevuer Sulunarine. 
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CROSS-COUPUNG EFFECT ON DEPTH U = 12 IGS 




CROSS-COUPLING EFFECT ON PITCH U = 12 KTS 




Figure 99. Depth and Pitch Response for Fixed Rudder Coinniands U 



12 Kts. 



15 OEG. COURSE CHANGE UC = 15 KTS. 




90 DEG. COURSE CHANGE UC = 15 KTS. 




Figure 100. Compensated Submarine Yaw Responses at 15 Kts. 
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10 FT. DEPTH CHANGE U = 15 KTS 




100 FT, DEPTH CHANGE U = 15 KTS 




Figure 101. Compensated Submarine Depth Responses at 15 Kts, 



I 




100 R. DEPTH CHANGE WITH 5 DEG. PITCH ANGLE 





Figure 102. Depth Cliange rvith 5 Deg. Down Pitcli Angle for Non-Linear Suh. 
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15 DEG. COURSE CHANGE UC = 20 fGS, 




90 DEG. COURSE CHANGE UC = 20 KTS. 




Figure 103, 



Coiniiensated Submarine \t\y\ Responses at 20 Kts 



10 FT. DEPTVI CHANGE U = 20 KTS. 
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Figure 104. Compensnted Submarine Depth Responses at 20 Kts. 
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PITCH RESPONSE TO 10 FT. DEPTH CHANGE 




PITCH RESPONSE TO 100 FT. DEPTH CHANGE 




Figure 105, 



Compensated Submarine Pitch Response to Depth Change Commands 



VI. CONCLUSIONS AND RECOMMENDATIONS FOR FURTHER 

WORK 



A. CONCLUSIONS 

I he linearization of given non-linear diUcrential equations of motion in six degrees 
of freedom, designing two automatic control systems using cascade compensator design 
techniques for vertical and horizontal motion of a submarine and finally investigating 
cross-coupling ellects due to the rudder dellcctions were the main concerns in this study. 

It has been shown that using linearized equations to design an automatic control for 
the actual non-linear system is possible for the submarine problem. Also cascade com- 
pensation, using a single loop technique, which was mainly the Bode plot design in this 
study, is possible and practical for automatic pitch, depth and yaw control of small 
submarines. 

The designed control systems for both planes satisfied the design specifications for 
a speed range from 8 to 20 Kts. 1 hat means the compensated system is rather insensitive 
to speed deviations. Therefore all problems related to gain switching, like cluttering and 
discontinuities in plane angles, are avoided. This is especially important because the 
forward speed changes significantly during maneuvers. 

I he implementation of the designed compensators into hardware has the following 
desirable features: 

1. .Minimal Instrumentation: Since rate information is not required, no inertial guid- 
ance system is necessary. Only a regular gyro for course and simple sensors for 
depth and pitch angle are needed. 

2. Low Cost. Weight and Size: The simplicity of the compensator transfer functions 
makes them easily realizable in physical hardware at low manufacturing cost. 
Weight and size requirements are very small, another important factor especially 
for small coastal submarines. A wide speed range is covered by one fixed 
compensator and no changes in parameters are necessary. 

3. Reliability: The automatic controller can be realized with a set of physical com- 
ponents with a well known high reliability. High component reliability and a small 
number of components will generally result in a high system reliability. 

B. RECOMMENDATIONS FOR FURIHER WORK 

1. I he designed control system in this study can keep the pitch and depth errors in 
reasonable limits for small rudder dellections and course changes. But larger dellections 
still create an appreciable amount of depth and pitch error at high speeds which is not 



1.36 



dcsirnbic Ibr near suifncc operations. It might be wortlnvhile to improve this design to 
get a sullicient control on cross-coupling cll'ccts for all kinds of heavy maneuvers. This 
can be done using dilTerent sets of parameters for the compensators and limiters and or 
increasing the numbers of compensators for the vertical control of the submarine. 

2. In some operational conditions it is very important to reach a desiied depth as 
soon as possible in a submarine. 1 herelbre an additional pitch angle command is given 
which has an enormous elfect on depth change rate. For the present design it is possible 
to give both depth and pitch command at the same time but the watch ollicer has to 
decide where to change the pitch command to zero. Otherwise, depending on the forward 
speed and commanded pitch angle, the submarine might not stay on desired depth. 

1 he present design can be modified using a new algorithm which can decide where 
and in what fashion to decrease the pitch angle automatically in order to get desiied 
depth and stay there without any unacceptable overshoot and steady state error. 
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APPENDIX A. DEFINITIONS OF SYMBOLS 



SYMBOL 

B 

m 

1 

U 

u 

%• 

w 

K 

X 

y 

z 



DEFINITION 



A dot over any symbol signifies dilTerenliation 
with respect to time. 

Buoyancy force which is positive upwards. 

.Mass of the submarine including the water in the 
free (loating spaces. 

Overall length of the submarine. 

Linear velocity of origin of body axes relative 
to an earth-fixed axis system. 

Component of U along the body x-axis. 

Component of U along the body y-axis. 

Component of U along the body z-axis. 

Conunand speed. 

Longitudinal axis of the body fixed coordinate 
axis system. 

fransverse axis of the body fixed coordinate 
axis system. 

Vertical axis of the body fixed coordinate axis 
system. 






Distance along the x axis of an earth-fixed 
axis system. 

Distance along the y axis of an earth-fixed 
axis system. 

Distance along the z axis of an earth-fixed 
axis system. 

Component of angular velocity about the body 
fixed x-axis. 

Component of angular velocity about the body 
fixed y-axis. 

Component of angular velocity about the body 
fixed z-axis. 



The z coordinate of the center of buoyance 
( CB ) of the submarine. 

Angle of attack. 

Angle of drift. 

Deflection of bow or fainvater planes. 
Deflection of rudder. 

Deflection of stern planes. 

I he ratio — . 



Mass density of sea water. 



Weight of water blown from a particular 
ballast tank identified by the integer assigned 
to the index i. 

Angular velocity. 

Time. 

Location along the body x-axis of the center 
of mass of the /''■ ballast tank when this tank is 
filled with sea water. 

Propulsion force. 

Moment of inertia of a submarine about the 
x-axis. 



Moment of inertia of a submarine about the 
y-axis. 



Moment of inertia of a submarine about the 
z-axis. 



Non-dimensional constants each of which is assigned 
to a particular force term in the equation of motion 
about the body x-axis. 

Non-dimensional constants each of which is assigned 
to a particular force term in the equation of motion 
about the body y-axis. 



All N's 



All X's 



All Y's 



All Z's 



Non-dimensional constants each of which is assigned 
to a particular force term in the equation of motion 
about the body z-axis. 

Non-dimensional constants each of which is assigned 
to a particular force term in the equation of motion 
along the body x-axis. 

Non-dimensional constants each of which is assigned 
to a particular force term in the equation of motion 
along the body y-axis. 

Non-dimensional constants each of which is assigned 
to a particular force term in the equation of motion 
along the body z-axis. 
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APPENDIX B. HYDRODYNAMIC COEFFICIENTS OF SIMULATION 

EQUATIONS 

A. AXIAL FORCE 



XQQ 


= -0.000200 


XRR 


= 


-0.000090 


XRP 


0.000250 


XU DOT 


= -0.000150 


XVR 


= 


0.011000 


XWQ 


-0.007500 


XUU 


= 0.0 


XVV 


= 


0.006500 


XDRDR = 


-0.002800 


XDSDS 


= -0.002500 


XDBDB 


= 


-0.002600 


XVVN = 


0.0 


XWWN 


= 0.0 


XDR2N 




0.0 


XDS2N = 


0.0 


-ATERAL 


FORCE 












YP r; 


= 0.0 


YPQ 


= 


0.000200 


YPDOT = 


-0.000300 


YRDOT 


= 0.000090 


YVDOT 


= 


-0.011000 


YV/R/ 


-0.007300 


YWP 


= 0.007500 


YR 


= 


0.003000 


YRDR = 


0.0 


YP 


= -0.000700 


YUU 


= 


0.0 


YV/V/ 


-0.060000 




= -0.021000 


YDR 


= 


0.006200 


YWV 


-0.065000 


YVS 


= 0.0 


YRN 


= 


0.0 


\VN 


0.0 


^'VAVN 


= 0.0 


YDRN 


= 


0.0 






s'ORiMAL 


FORCE 












ZRR 


= -0.001500 


ZRP 


= 


-0.000900 


ZQDOT = 


-0.000200 


ZWDOT 


= -0.007500 


ZVR 


= 


-0.008000 


ZW,Q/ = 


-0.006000 


ZQ 


= -0.004500 


ZQDS 


= 


0.0 


ZVP 


-0.007000 


ZUU 


= -0.000100 


ZVV 


= 


0.000650 


ZW/W/ = 


-0.030000 


zw 


= -0.011000 


ZDS 


= 


-0.005000 


ZDB 


-0.002500 


Z'W/ 


= 0.0 


ZWW 


= 


0.0 


ZVS 


0.0 


ZQN 


= 0.0 


ZWN 


= 


0.0 


ZWAWN = 


0.0 


ZDSN 


= 0.0 


Z + VP 


= 


0.0 
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D. ROLLING MOMENT 



KP,P/ 


= 


-0.0000008 


KQR 


KRDOT 


= 


-0.000007 


KVDOT 


KR 


= 


-0.0000-40 


KP 


KV;V/ 


= 


-0.000900 


KV 


KWV 


= 


0.003500 




PITCHING MOMENT 




MRR 


= 


-0.0005500 


MRP 


M + RP 


= 


0.0 


MWDOT 


M;W,Q 


= 


-0.002000 


MQ 


MVP 


= 


0.000900 


MUU 


MW/W/ 


= 


-0.005000 


MW 


MDB 


= 


0.000500 


M/W/ 


MQN 


= 


0.0 


MWN 


MDSN 


— 


0.0 




YAWING MOMENT 




NPQ 


= 


-0.0004000 


NPDOT 


NVDOT 


= 


0.000300 


N/V/R 


NR 


= 


-0.003000 


KRDR 


NL'U 


= 


0.0 


NV/V; 


NDR 


= 


-0.003000 


NWV 


NVN 


= 


0.0 


NVAVN 


OTHERS 


A1 


= 


-0.001000 


A2 


LC 


= 


415.0 


ML 


IX 


= 


7.31 LvKH 


lY 



= -0.000100 


KPDOT 


= -0.000003 


= -0.000250 


KWP 


= 0.000250 


= -0.000035 


KUU 


= 0.0 


= -0.000700 


KDR 


= 0.000070 



= 0.000150 


MQDOT = -0.000400 


= -0.000200 


MVR = -0.002000 


= -0.002500 


MQDS = 0.0 


= 0.000040 


MW = 0.015000 


= 0.003000 


.MDS = -0.002500 


= 0.0 


MWW = 0.0 


= 0.0 


MWAWK= 0.0 



-0.000007 


NRDOT 


= -0.000500 


-0.004500 


NWP 


= -0.000200 


0.0 


NP 


= -0.000005 


0.014000 


NV 


= -0.007500 


0.015000 


NRN 


= 0.0 


0.0 


NDRN 


= 0.0 



-0.000950 


A3 


= 0.001950 


0.0087445 


BZB 


= 0.0010114 


5.6867.vl0-^ 


IZ 


= 5.6867.rl0 
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APPENDIX C STANDARD EQUATIONS OF MOTION 



A. AXIAL FORCE 



m{u - IT + wq) = y !^\_Xqqq^ + 

+ y 

+ y + Xvvv^ + X^^w^^ 

+ j- /'«'[ Wr' + W^'] 

+ y l^X^.^^,„(n — l)iv^ 

+ y - l)(5j 

-Zl^'/sinO 
+ i^x)p 
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B. LATERAL FORCE 

m{v - wp + w) = y /^C } / + 

+ -ji^Lypgpq+ yp\p\p\pU 
" 2 " ^ ^ + y^p^^P + ^\|r| + »’^) 2 llr| 

+ y/^[>>' + }'|;.|^,«|ji(5r + YpUp'] 

+ y + > v'«' + > v|v|^i(‘'‘^ + 

+ y YsuhSrSr 
+ Yl^ti^Y^„,(ii - ])< 5 r 

+ y 

, + - l)ii(v-^ + w')'y\ 

n 2,2 

I ^ Pi rr \ V "Fu* ^ ^ . 

+ y ' U y)vs — Jj — ( -10 sm col 
+ XI B',- sin <j) cos 0 
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C. NORMAL FORCE 



- uq + rp) = -jl^Z^q 

+ -|/"[Z,/ + V/.] 

+ y C Z^W + Zypr + ZypVp + AZypVp ] 

+ y + z:^^\6s^\q\ds + Z^,|,| ly \{v^ + n;^)T||<7| j 

+ -^ /%,(// -IH 

+ y + Z^uw + Z^|^.|ui(v^ + IV^)T| J 

+ /'[Z|„|;/h.| + Z,J»v(v' + u--')T|Z,,v'] 

+ j-l^lZ,,Ss + Z,,Sb-] 

+ j- /'[Z,„(» - I)mv + Z,|,|„(,» - I)>v|(v' + w')T|] 

+ y /VZ<5,„(«- 1)<55 

. a, r- \ +*‘'^ 

+ y ^ — jj — sin OJI 

+ cos (/) cos 0 
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D. ROLLING MOMENT 

JxP + (^2 - = Y + ^'/^';,|p|/’l/’III 

+ f[^KpUp -\-Kpir + A'yV + AY»yO 

+ Y + ^'v|vi''i(^^ + 

. P ,3,.. 

+ Y ‘ 

I ^ P 2i- ? 

+ — / // A^^()r 
+ /? 2 g sin (/) cos 0 
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\ 

E. PITCHING MOMENT 



^y<J + Ux - ^:)>r = -J + ‘^lrp>P + 

+ y I^M^uq + i\/|^|,,,»|(7|05 + ^U|^|^|(v^ + I*?] 

+ y 

+ y l‘^Mg„{n — l)uq 

+ y + ‘'•')l'l] 

+ /^|^‘P|M;|'^l“'i + ^Pw’ul'K'''^ + ^ I + 

+ y 

+ y /^\p,,(/j- l)mv 
+ y/'^^AvM.(«-l)‘v|(v' + a-')T| 

+ y - 1)()5 

+ Bz^ sin 0 
+ cos 4> cos 0 
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F. YAWING moment 

Lr + (/j, - l^jH] = 4- + A'^/>] 

+ ~2 ^ [a,!/;- + A|^|^^j/|/i()r + A|,|,|(i-^ + u-^j 2 |; J 
+ y l\^'pi<P + A'v'’ + A'^piiyO 
+ y - 1 )'»' 

T 2 ^ + Ayj/v+ A^,|^,|^|(l• + ir )*|J 

+ y l^u^N^^Sr 

+ y l^Ny„{n - l)!n- 
+ y / Aj.|,.|„(/ 2 — l)ii(i-^ + if^) 2 1 
+ T 

+ Z*F,-.r„- sin 0 cos 
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G. AUXILARY EQUATIONS 



4> = p + ’ll/ sin 0 



e = 



q — COS 0 sin 4> 
cos </) 



• r + 0 sin 4> 

V — r 

cos 4> cos d 

xq = u cos 6 cos \l/ + v( sin 4> sin 6 cos i/^ — cos 4> sin 
+ h( sin 0 sin i/' + cos 0 sin 6 cos 0) 

jo = u cos 6 sin 0 + v( cos 0 cos 0 + sin 0 sin 6 sin 0) 
+ iv( cos 0 sin 6 sin 0 — sin 0 cos 0) 

ig = —u sin 6 + V cos 0 sin 0 + vv cos 0 cos 0 



i^x)p = y 
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ATPENDIX D. SIMULATION PROGRAM TOR LINEARIZED 



VERTICAL EQUATIONS OF MOTION 

* THIS PROGRAM SIMULATES THE LINEARIZED SUBMARINE EQUATIONS 

* IN THE VERTICAL PLANE. 

Vr 

Vc 

TITLE SUBMARINE EQUATIONS FOR THE VERTICAL PLANE 

* AXIAL SPEED 
CONST U=8. 4A5 
INITIAL 

DS=0. 0 
DB=0. 0 
DERIVATIVE 

DB=0. 0*STEP(0) 

DS=0. 0*STEP(0) 

THETA=INTGRL(0. 08726, Q) 

DEPTH = INTGRLC . 0 , ZDOT) 

Q=INTGRL(. 0,QD0T) 

ZDOT=INTGRL(-0. 736,ZDDOT) 

Yl=-1. 728E-3*U*ZDOT 
Y4=-0. 706*U*Q 

Y5=(0. 0128-( 1. 728E-3)*U*U)*THETA 

Y2=-6. 667E-4*U*U*DS 

Y3=-3. 873E-4*U’^^U*DB 

ZDD0T=Y 1+Y2+Y3+Y4+Y5 

Y0=1. 884E-5’-U*ZDOT 

Y9=-6. 365E-3*U*Q 

Y6=3. 193E-6*U*U*DB 

Y7=-1.465E-5'-'-U*U*DS 

Y8=(( 1. 884E-5)*U*U-2. 522E-3)*THETA 

QDOT=YO+Y8+Y6+Y7+Y9 

DEP=INTGRL(. 0,ZDOT) 

CONTROL FINTIM=360 
PRINT 1 . , THETA , DE PTH , Z DOT 
SAVE 0. 1,W, ZDOT, THETA. DEP 
GRAPH( DE=TEK6 18 )TIME , THETA , DEP 

LABEL INITIAL CONDITION RESPONSE IN. PITCH=5 DEG. U=5 KTS. 
GRAPH(DE=TEK618)TIME,ZDOT 

LABEL INITIAL CONDITION RESPONSE IN. PITCH=5 DEG. U=5 KTS. 
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APPENDIX E. SIMULATION PROGRAM FOR LINEARIZED 



HORIZONTAL EQUATIONS OF MOTION 

* THIS PROGRAM SIMULATES THE LINEARIZED SUBMARINE EQUATIONS 

* IN THE HORIZONTAL PLANE. 



Vc 

TITLE SUBMARINE EQUATIONS FOR THE HORIZONTAL PLANE 

Vc 

* AXIAL SPEED 

CONST U=30. 4 

INITIAL 

DR=0. 0 

DERIVATIVE 

Yl=l. 89*RD0T 
Y2=-6. 3*PDOT 
Y3=-0. 291->U*R 
Y4=-0. 035*U*P 
Y5=-2. 563E-3*U*V 
Y6=7. 568E-4*U*U’'-DR 
VD0T=YI+Y2+Y3+Y4+Y5+Y6 
Y7=-0. 679*RDOT 
Y8=-0. 0584*VD0T 
Y9=-9. 347E-3*U*R 
Y10=-8. I79E-3*U*P 
YlI=-3. 942E-4*U*V 
YI2=3. 942E-5*U*U*DR 
YI3=0. 236-'-PHI 

PD0T=Y7+Y8+Y9+Y10+YII+YI2-YI3 

YI4=-6. 553E-3*PD0T 

Y15=6. 767E-4*VDOT 

Y16=-6. 767E-3*U*R 

Y17=-4. 5IlE-6-'-U*P 

Y18=-4. 076E-5*U*V 

Y19=-l. 631E-5*U*U*DR 

RD0T=Y14+Y15+Y16+YI7+YI8+Y19 

P=INTGRL(. O.PDOT) 

V=INTGRL(. O.VDOT) 

R=INTGRL(. 0,RD0T) 

* PHI=INTGRL(0. 43633, P) 

PHI=INTGRL(0. 0,P) 

XI=INTGRL(. 0,R) 

DYNAMIC 

IF(TIME. GE. 10) DR = 0. 611 
IF(TIME. GE. 40) DR = -0.611 
IFCTIME. GE. 70) DR = 0. 0 
DRDEG = DR*57. 296 
ROLDEG= PHI----5 7. 296 
YAWDEG= X 1*5 7. 296 

CONTROL FINTIH=360 
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PRINT 1. ,V,YAWDEG,ROLDEG 

SAVE 0. 1,V,YAWDEG.R0LDEG,DRDEG 

GRAPH( DE=TEK6 1 8 )TIME , YAWDEG , ROLDEG 

LABEL FORCED RESPONSE TO 35 DEG. RUDDER U=18 KTS. 
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APPENDIX F. SIMULATION PROGRAM FOR THE COMPENSATED 

SYSTEM IN VERTICAL MOTION 

* THIS PROGRAM SIMULATES THE COMPENSATED SUBMARINE MOTIONS 

* IN THE VERTICAL PLANE. 



TITLE SUBMARINE SIMULATION 
PARAM K1 = 0. 015 
PARAM K2 = 2.0 
PARAM UC = 10.4 
PARAM ZOR= 100. 

PARAM POR= 0. 0 

DERIVATIVE 

PITCH=INTGRL(0. 0,Q) 

DEPTH = INTGRL(. 0,ZDOT) 

Q=INTGRL(. 0,QDOT) 

ZDOT=INTGRL(-0. 736,ZDDOT) 

Yl=-1. 728E-3*U*ZDOT 
Y4=-0. 706*U*Q 

Y5=(0. 0128-C 1. 728E-3)*U*U)*PITCH 

Y2=-6. 667E-4*U*U*DS 

Y3=-3. 873E-4*U*U*DB 

ZDDOT=Yl+Y2+Y3+Y4+Y5 

Y0=1. 884E-5*U-"'ZDOT 

Y9=-6. 365E-3*U*Q 

Y6=3. 193E-6’'-U*U--'-DB 

Y7=-l. 465E-5*U*U*DS 

Y8=((l. 884E-5)*U*U-2. 522E-3)*PITCH 

QD0T=Y0+Y8+Y6+Y7+Y9 

DEP=INTGRL(. 0,ZDOT) 

ZER = ZOR - DEPTH 
PER = POR - PITCH 
ZERR= LIMIT(-LIM,LIM,ZER) 

PERR= LIMIT(-LIM,LIM,PER) 

DYNAMIC 

IF(UC. LT. 15. ) LIM = 35. 

IF(UC. GE. 15. ) LIM = 25 
IF(UC. GE. 25. ) LIM = 15. 

*COMPENSATOR GCll 

Cll = -K1*ZERR 

C12 = LEDLAG(0. ,1.0,0. 1,C11) 

DB = REALPL(0. ,. 667,C12) 
*COMPENSATOR GC22 

C21 = -K2*PERR 

DS = REALPL(0. ,.667,C21) 

DSDEG = 57. 296"'DS 
DBDEG = 5 7. 296*DB 
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PITDEG = 5 7. 296*PITCH 
CONTROL FINTIM=360 

SAVE 0. 1, DEPTH, ZUOT, PITDEG, DSDEG,DBDEG 
PRINT 1. , PITDEG, DEPTH, ZDOT,DSDEG,DBDEG 
GRAPH( DE=TEK618)TIHE , PITCH , DEPTH 
LABEL 100 FT. DEPTH CHANGE U=6 KTS. 
GRAPH( DE=TEK6 18 ) DBDEG , DSDEG 
LABEL 100 FT. DEPTH CHANGE U=6 KTS. 
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APPENDIX G. SIMULATION PROGRAM FOR THE COMPENSATED 



SYSTEM IN HORIZONTAL MOTION 

* THIS PROGRAM SIMULATES THE COMPENSATED SUBMARINE MOTIONS 

* IN THE HORIZONTAL PLANE. 



TITLE SUBMARINE SIMULATION FOR THE HORIZONTAL PLANE 

Vr 

PARAM K1 =1.00 
PARAM LIN = 0.065 
PARAM U = 30. 4 
PARAM 0RYAW=0. 2618 

DERIVATIVE 

Yl=l. 89*RD0T 
Y2=-6. 3-PDOT 
Y3=-0. 291--U--R 
Y4=-0. 035^>U’>P 
Y5=-2. 563E-3’>U*V 
Y6=7. 568E-4*U*U*DR 
VD0T=Y1+Y2+Y3+Y4+Y5+Y6 
Y7=-0. 679->RDOT 
YS=-0.0584’‘-VD0T 
Y9=-9. 347E-3*U'-R 
Y10=-8. 179E-3*U*P 
Yll=-3. 942E-4-->U*V 
Y12=3. 942E-5*U*U*DR 
Y13=0. 236-'-PHI 

PDOT=Y7+Y8+Y9+Y10+Y11+Y12-Y13 

Y14=-6. 553E-3*PD0T 

Y15=6. 767E-4*VDOT 

Y16=-6. 767E-3*U*R 

Y17=-4. 511E-6*U^--P 

Y18=-4. 076E-5--U*V 

Y19=-]. 631E-5-'-U’>U=>DR 

RL)OT=Y14+Y15+Y16+Y17+Y18+Y19 

P=INTGRL(. O.PDOT) 

V=INTGRL(. 0,VD0T) 

R=INTGRL(. O.RDOT) 

PHI=JNTGRL(0. 0,P) 

XI=INTGRL(. 0,R) 

DYNAMIC 

IF(U. LT. 20. 3) LIM=0. 070 
IF(U. GE. 20. 3) LIM=0.050 
IF(U. GE. 30.4) LIM=0. 035 
ERR = OR YAW - XI 
LERR= LIMIT( -LIM,LIM,ERR) 

’•COMPENSATOR GCll 

LCIA = -K1*LERR 
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LCIB = LEDLAG(0. ,100. ,10. ,LC1A) 

DR = REALPL(0. ,. 667, LCIB) 

DRDEG = DR*57. 296 
ROLDEG= PHI-->57.296 
YAWI)EG= XI*57.296 
CONTROL FINTIM=360 
PRINT 1. ,V,YAWDEG, DRDEG, ROLDEG 
SAVE 0. 1,V,YAWDEG,R0LDEG, DRDEG 
GRAPHC DE=TEK6 1 8 ) TI ME , YAWDEG . ROLDEG 
LABEL 15 DEGREE COURSE CHANGE U=18 KTS. 

GRAPHC DE=TEK6 18 )TIME , DRDEG 

LABEL RUDDER RESPONSE TO 15 DEG. COURSE CHANGE U=18 KTS. 
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APPENDIX II. SIMULATION PROGRAM FOR NON-LINEAR 

EQUATIONS OF MOTION 

*THIS PROGRAM SIMULATES NON-LINEAR EQUATIONS OF MOTION IN SIX DEGREES 
*OF FREEDOM FOR A SUBMERGED SUBMARINE 

Vr 

TITLE NONLINEAR SIX DEGREE OF FREEDOM SUBMARINE SIMULATION 

PARAM UC = 18.58 
■>v 

*BALLAST TANKS CONTAINS FOR DIFFERENT AXIAL SPEEDS 



’•'FOR ; 


5 KTS 




’■'ARAM 


AT = 


-0. 800E-5 


’•'ARAM 


FT = 


0. 800E-5 


’•'ARAM 


AU = 


1. 400E-5 


’•'FOR 1 


5 KTS 




’•'ARAM 


AT = 


-1. 03E-5 


’•'ARAM 


FT = 


1. 03E-5 


’•'ARAM 


AU = 


2. 500E-5 


’•'FOR 1 


5 KTS 




’•'ARAM 


AT = 


-1. 85E-5 


’•'ARAM 


FT = 


1. 85E-5 


’■'ARAM 


AU = 


4. 50E-5 


’•'FOR ' 


9 KTS 




’•'ARAM 


AT = 


-2. 35E-5 


’•'ARAM 


FT = 


2. 35E-5 


’•'ARAM 


AU = 


5. 70E-5 


’••■FOR 


10 KTS 


PARAM 


AT = 


-2. 85E-5 


PARAM 


FT = 


2. 85E-5 


PARAM 


AU = 


7. OOE-5 


’•'FOR 


12KTS 




’•'ARAM 


AT = 


-4. 138E-5 


’•'ARAM 


FT = 


4. 138E-5 


’•'ARAM 


AU = 


9. 77E-5 


’•'FOR 


18 KTS 




’•'ARAM 


AT = 


-8. 400E-5 


’•'ARAM 


FT = 


8. 400E-5 


’•'ARAM 


AU = 


1. 80E-4 


’•'FOR 


2 5 KTS 




’•'ARAM 


AT = 


-9. 080E-5 


’•'ARAM 


FT = 


9. 080E-5 


’■'ARAM 


AU = 


2. lOOE-4 



’■PRECALCULATED COFACTORS 

PARAM DEL=. 18901E-16, 

PARAM COFAD = 0.0, 

PARAM COFBB=. 153152E-14, 

PARAM COFBF=. 17543E-12, COFCA=0. 0, 



COFAA=. 212502E-14, COFAB = 0.0, 
COFAE = 0. 0, COFAF = 0. 0, 

C0FBC=0. 0, C0FBD=-. 186106E-10, 



COFAC = 0. 0 
COFBA = 0. 0 
COFBE = 0.0 



COFCB = 0.0, COFCC =. 11665E-14 
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PARAM COFCD = 0.0, COFCE=-. 999506E- 13 , COFCF = 0.0, COFOA = 0.0 
PARAM COFUB=-. 905797E-16,COFDC=0. 0, COFUD=. 294191E-11 , COFDE = 0.0 
PARAM COFDF=-. 224359E-13,COFEA=0. 0, COFEB = 0.0, COFEC=-. 58035E- 18 
PARAM COFED = 0.0, COFEE=. 19562E-13 , COFEF = 0.0, COFFA = 0.0 
PARAM COFFB=. 162929E-17, COFFC=0.0, COFFD=-. 31859 IE- 13 , COFFE = 0. 0 
PARAM COFFF =. 179521E-13 



-•HYDRODYNAMIC COEFFICIENTS AND SUBMARINE CHARACTERISTICS 



■>r 

PARAM 


LC = 415. 0, ML 


= .0087445, A1 = -0 


.001, 


1 

II 

CM 

< 


D0095, A3 = . 


00195 


PARAM 


IX=7. : 


3114E-6,IY=5. 6867E-4, IZ = 5. 


6867E-4 








PARAM 


XUDOT 


=-. 00015 


, XVR = .011, XWQ = 


-. 0075 


, XVV = 


.0065, Xlv’W = 


^ 002 


PARAM 


XDRDR 


=-. 0028, 


XDSDS=-. 0025,XDBDB= 


-. 0026, 


XQQ =-, 


.0002, XRR=-. 


00009 


PARAM 


XRP 


= . 00025 












PARAM 


YVDOT 


=-. on. 


Y1^7P = . 0075, YV = 


-. 021, 


Y1V1V= 


-. 06, YR = 


: . 003 


PARAM 


YVIRI 


=-. 0073, 


YP =-. 0007,YRDOT= 


. 00009, 


YPDOT= 


-. 0003, YDR = 


0062 


PARAM 


YPQ 


=. 0002, 


YVV =-.065 










PARAM 


ZWDOT 


=-. 0075, 


ZVP =-. 007, ZS = 


-. 0001 , 


ZW = 


-.011, zwiv;i= 


:-. 03 


PARAM 


ZVV 


=. 065, 


ZQ =-. 0045,ZW1Q1= 


-. 006, 


ZVR = 


-.008, ZRR =- 


. 0015 


PARAM 


ZDS 


= -. 005, 


ZDB =-. 0025,ZQDOT= 


-. 0002, 


ZlWl = 


0. 0, ZWW = 


0. 0 


PARAM 


ZRP 


= -. 0009 












PARAM 


KPDOT 


=-3. E-6, 


KQR =-. 0001,KRDOT= 


-7. E-6, 


K1P1P= 


-8.E-7, KV =- 


•. 0007 


PARAM 


KIVIV 


=-. 0009, 


KP =-3.5E-5, KR = 


-4. E-5, 


KVDOT= 


-. 00025, KV\v'=. 


0035 


PARAM 


KDR 


=7. E-5, 


Klv'P = 2.5E-4 










PARAM 


MODOT 


=-. 0004, 


MRP =.00015, MS = 


4. E-5, 


m = 


.003, M1W1W=- 


•. 005 


PARAM 


MW 


=. 015, 


MQ =-. 0025,H1W1Q= 


-. 002, 


MVR = 


-.004, MRR=-. 


00055 


PARAM 


UWDOT 


=-. 0002, 


HDS =-.0025, MDB = 


. 0005, 


MlWl = 


0. 0, MVP =. 


0009 


PARAM 


NRDOT 


=-5. E-4, 


NPQ =-4. E-4,NPD0T= 


-7. E-6, 


NV = 


-. 0075,N1V1V= 


=. 014 


PARAM 


NR 


=-. 003, 


NIVIR =-. 0045, NP = 


-2. E-6, 


NVDOT = 


. 0003, NDR =- 


•. 003 


PARAM 


Nlv'V 


=. 015, 


NWP =-. 0002 










PARAM 


BZB 


=1. 011413E-3 










INCON 


YADOT 


= 0.0, RODOT = 0.0, PIDOT = 


0. 0 








INCON 


DS = 1 


0. 0 , DB 


= 0. 0, DR =0. 0 











CONTRL FINTIM=360. ,DELT=. 01 ,DELS=. 5 
PRINT 1. ,V,YAWGRA,ROLGRA, DEPTH, PITGRA 

INITIAL 

LC2 = LC-''*2 
IZX = IZ-IX 
lYX = lY-IX 
IZY = IZ-IY 

DYNAMIC 



IF(TIME. GE. 10) DR 
IFCTIME. GE. 10) DB 
IF(T1ME. GE. 40) DR 
IF(TIME. GE. 40) DB 
IFCTIME. GE. 70) DR 
IFCTIME. GE. 70) DB 



=0. 611 
=0. 611 
=-0. 611 
=-0. 611 
= 0 . 0 
= 0 . 0 



DERIVATIVE 

Vr 

’■•PRECALCULATION FOR EQUATIONS OF MOTION 

“.V 

PAl = XDRDR---U’'--U-'DR---DR/LC 
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PA2 = XDSDS*U*U*DS*DS/LC 
PA3 = XDBDB*U*U*DB*DB/LC 
PB = YDR*U*U*DR/LC 
PC2 = ZDS-''U*U-'--DS/LC 
PC3 = ZDB*U*U*DB/LC 
PD = KDR*U’>U*DR/LC2 
PE2 = MDS->U*U*DS/LC2 
PE3 = MDB*U*U^-DB/LC2 
PF = NDR’>U*U*DR/LC2 
PA = PAl + PA2 + PA3 
PC = PC2 + PC3 
PE = PE2 + PE3 
ABV = ABS(V) 

ABW = ABS(W) 

ABP = ABS(P) 

ABQ = ABS(Q) 

ABR = ABS(R) 

V\W= V*V + W*W 
AVW = SQRT(VVWW) 

ABWP=FCNSW(W,-1. ,0. ,1. ) 

ABVP=FCNSW(V,-1. ,0. ,1. ) 

SAl =+LC*(XQQ*Q**2 + XRR*R**2 + XRP*R*P) 

SA2 =+(ML*V*R + XVR*V*R + XT^/Q^W^’^Q -ML*W*Q) 

SA3 =+(XVV*V’>*2 + XWW*W**2)/LC - SIN(PITCH)*(AT+FT+AU) 

SA4 =+(Al*U**2 + A2*U*UC + A3*UC**2)/LC 
SBl =+LC*YPQ*P*Q 

SB2 =+(Y\i/P*W*P + YV1R1*ABR*AW*ABVP +ML*W*P - ML*U*R) 

SB3 =+(YVV'-'W*V + Y1V1V*AVW*V)/LC + SIN(R0LL)*C0S( PITCH)*( AT+FT+AU) 
SB4 =(YR*R +YP*P +YV*V/LC)*U 
SCI = LC-''R*(ZRR*R + ZRP*P) 

SC2 =+(ZVP*V*P + ZVR’'-V*R + ZW1Q1*ABQ*AVW*ABWP + ML*U*Q - ML*P*V) 
SC3 =+(ZWW-*2 + ZVV*V**2 + ZW1W1*W*AW + U*Z1W1*ABW + U*U*ZS)/LC 
SC4 = ZQ*U*Q + ZW*U*W/LC + COS( PITCH)*COS(ROLL)*( AT+FT+AU) 

SDl =+(KQR*Q*R + K1P1P*ABP*P) - IZY*Q^''R 
SD2 = (KVP*W*P-BZB*SIN(ROLL)*COS(PITCH))/LC 
SD3 =+(KlVlV*V*AVW + KVW*V*W + KS*U**2)/LC2 
SD4 = ((KP-->P + KR*R)/LC + KV*V/LC2)*U 
SEl = (MRP^'^P + MRR->R + IZX-’'P)-'-'R 

SE2 = ((MVR*R + MVP*P)*V + M1W1Q-''AVW*Q - BZB*SIN(PITCH))/LC 

SE3 =(MVV*V-'”’^2 + MWW-->W**2 + M1W1W--AW->W +M1W1*U-''AVW + U^’“’-2*MS)/LC2 

SE4 = HQ’-'U*Q/LC + (MW*U*W -( 175. 5*FT-219. 5*AT)*C0S(PITCH)*. . . 

COS(ROLL))/LC2 

SFl = (NPQ-IYX)*P*Q 

SF2 =+(NlVP-nV*P + N1V1R*AVW*R)/LC 

SF3 = (N\v'V*W + N1V1V*AVW)*V/LC2 

SF4 = (NP*P+NR^’^R)*U/LC+(NV’''U--'-V+( 175. 5*FT-219. 5*AT)*C0S( PITCH)*. . . 
SIN(R0LL))/LC2 



SA 


= SAl 


+ 


SA2 


+ 


SA3 


+ 


SA4 


SB 


= SBl 


+ 


SB2 


+ 


SB3 




SB4 


SC 


= SCI 


+ 


SC2 


+ 


SC3 


+ 


SC4 


SD 


= SDl 


+ 


SD2 


+ 


SD3 


+ 


SD4 


SE 


= SEl 


+ 


SE2 


+ 


SE3 


+ 


SE4 


SF 


= SFl 


+ 


SF2 


+ 


SF3 


+ 


SF4 



ZA = SA + PA 
ZB = SB + PB 
ZC = SC + PC 
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ZD = SD + PD 

ZE = SE + PE 

ZF = SF + PF 

Vr 

*EQUAT10NS OF MOTION 

Vf 

UDOT =(COFAA*ZA+COFAB*ZB+COFAC*ZC+COFAD*ZD+COFAF.*ZE+COFAF*ZF)/DF.I, 
VDOT =(COFBA-'ZA+COFBB*ZB+COFBC*ZC+COFBD*ZD+COFBE*ZE+COFBF*ZF)/DEL 
WDOT =(COFCA*ZA+COFCB*ZB+COFCC'<ZC+COFCD*ZD+COFCE*ZE+COFCF*ZF)/DEL 
FDOT =(COFDA*ZA+COFDB*ZB+COFDC*ZC+COFDD*ZD+COFDE*ZE+COFDF*ZF)/UEL 
QDOT =(COFEA*ZA+COFEB*ZB+COFEC*ZC+COFED*ZD+COFEE*ZE+COFEF*ZF)/DEI. 
RDOT =(COFFA*ZA+COFFB*ZB+COFFC*ZC+COFFD*ZD+COFFE*ZE+COFFF*ZF)/DEL 

* 

’•-AUXILARY EQUATIONS 

•V 

ZODOT =-U*SIN(PITCH)+V*COS(PITCH)*SIN(ROLL)+W*COS(PITCH)*COS(ROLL) 
PILOT = Q*COS(ROLL)-R*SIN(ROLL) 

YADOT = (R’’’COS(ROLL)+Q*SIN(ROLL))/COS(PITCH) 

RODOT = P+YADOT-”-SIN(PITCH) 

U = INTGRL(UC,UDOT) 

V = INTGRL(0. ,VDOT) 

W = INTGRL(0. ,WDOT) 

P = INTGRL(0. ,PDOT) 

Q = INTGRL(0. ,QDOT) 

R = INTGRL(0. ,RDOT) 

DEPTH = INTGRL(0. , ZODOT) 

* ROLL = INTGRL(0. 43633, RODOT) 

ROLL = INTGRL(0. 0, RODOT) 

* PITCH = INTGRL(0. 7854, PILOT) 

PITCH = INTGRL(0. 0,PID0T) 

YAW = INTGRL(0. , YADOT) 

DBGRA = DB’'^57. 296 

DSGRA = DS’’^57. 296 
DRGRA = DR-'^57. 296 
PITGRA= PITCH’‘’57. 296 
ROLGRA= ROLL*57. 296 
YAWGRA= YAW--57.296 

SAVE 0. 1,V, DEPTH, YAW, PITGRA, ROLL, ZODOT 
GRAPH( DE=TEK6 1 8 )TIHE , DEPTH , ZODOT , PITGRA 
LABEL NI. PITCHO. 04RAD. U=18. 58 FT/SEC. NO PLANES 
GRAPH( DE=TEK6 1 8 )TINE , ROLL , YAW , V 

LABEL INI.R0LL=0. 1 RAD. U=18. 580 FT/SEC. NO PLANES 
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APPENDIX I. 



COMPENSATED NON-LINEAR MODEL 



*THIS PROGRAM SIMULATES THE COMPENSATED NON-LINEAR SUBMARINE IN SIX 
*DEGREES OF FREEDOM 

Vf 

TITLE COMPENSATED NONLINEAR SIX DEGREE OF FREEDOM SUBMARINE SIMULATION 

PARAM KH = 1. 00 

PARAM K1 = 0. 015 

PARAM K2 = 2. 0 

PARAM UC = 18. 69 

*ARAM ORYAW=1.5726 

PARAM ORYAW=0. 2618 

*PARAM ZOR=10. 

PARAM POR=0. 0 

Vf 

’■'BALLAST TANKS CONTAINS FOR DIFFERENT AXIAL SPEEDS 



*FOR ! 


5 KTS 




*ARAM 


AT = 


-0. 800E-5 


*ARAM 


FT = 


0. 800E-5 


■••'ARAM 


AU = 


1. 400E-5 


*FOR ( 


3 KTS 




*ARAM 


AT = 


-1. 030E-5 


*ARAM 


FT = 


1-. 030E-5 


*ARAM 


AU = 


2. 500E-5 


*FOR 8 KTS 




*ARAM 


AT = 


-1. 85E-5 


*ARAH 


FT = 


1. 85E-5 


*ARAM 


AU = 


4. 5E-5 


*FOR ! 


? KTS 




PARAM 


AT = 


-2. 35E-5 


PARAM 


FT = 


2. 35E-5 


PARAM 


AU = 


5. 7E-5 


’■'FOR 


12 KTS 




’■'ARAM 


AT = 


-4. 138E-5 


’■'ARAM 


FT = 


4. 138E-5 


’^'ARAM 


AU = 


9. 77E-5 


’•'FOR 


18KTS 




’■'ARAM 


AT = 


-8. 400E-5 


’>ARAM 


FT = 


8. 400E-5 


’■'ARAM 


AU = 


1. 80E-4 


’■'FOR : 


2 5 KTS 




’■'ARAM 


AT = 


-9. 080E-5 


’■'ARAM 


FT = 


9. 080E-5 


vARAM 


AU = 


2. lOOE-4 



•'PRECALCULATED COFACTORS 



PARAM DEL=. 18901E-16, COFAA=. 212502E-14, COFAB = 0.0, COFAC 
PARAM COFAD =0.0, COFAE =0.0, COFAF =0.0, COFBA 
PARAM COFBB=. 153 152E- 14, COFBC=0. 0, COFBD=-. 186106E-10 , COFBE 



0 . 0 
0 . 0 
0 . 0 



162 



PARAtl COFBF=. 17543E-12, C0FCA=0. 0, COFCB = 0.0, COFCC =. 1 1665F,- 14 
PARAM COFCD = 0.0, COFCE=-. 999506E-13 ,COFCF = 0.0, COFDA = 0.0 
PARAtl COFDB=-. 905797E-16,C0Fl)C=0. 0, COFDD=. 294191E- 1 1 , COFDE = 0.0 
PARAM COFDF=-. 224359E-13,C0FEA=0. 0, COFEB = 0.0, COFEC=-. 58035E-18 
PARAM COFED = 0.0, COFEE=. 19562E-13 , COFEF = 0.0, COFFA = 0.0 
PARAM COFFB=. 162929E- 17, C0FFC=0.0, COFFD=-. 318591E- 13 , COFFE = 0. 0 
PARAM COFFF =. 179521E-13 



*HYDRODYNAMIC COEFFICIENTS AND SUBMARINE CHARACTERISTICS 



•JC 

PARAM 


LC = 415.0, ML 


= . 0087445, A1 = -0. 001, 


A2 = -. ( 


30095, A3 = . 


, 00195 


PARAM 


IX=7. 3114E-6,IY=5. 6867E-4, IZ = 5. ' 


6867E-4 








PARAM 


XUDOT 


=-. 00015 


, XVR 


= .011, XIVQ = 


-. 0075 


, XVV = 


. 0065 , XW = 


=. 002 


PARAtl 


XDRDR 


=-. 0028, 


XDSDS=-. 0025,XDBDB= 


-. 0026, 


XQQ =-, 


.0002, XRR=-, 


. 00009 


PARAM 


XRP 


= . 00025 














PARAM 


YVDOT 


=-. on. 


YIVP 


= . 0075, YV = 


-. 021, 


Y1V1V= 


-. 06, YR = 


= . 003 


PARAM 


YVIRI 


=-. 0073, 


YP 


=-. 0007,YRD0T= 


. 00009, 


YPDOT= 


-. 0003, YDR = 


=. 0062 


PARAM 


YPQ 


=. 0002, 


WV 


=-. 065 










PARAM 


ZWDOT 


=-. 0075, 


ZVP 


=-.007 , ZS = 


-. 0001, 


ZW = 


-.011, ZWIWD 


=-. 03 


PARAM 


ZVV 


=. 065, 


ZQ 


=-. 0045,ZW1Q1= 


-. 006, 


ZVR = 


-. 008, ZRR = 


-. 0015 


PARAM 


ZDS 


=-. 005, 


ZDB 


=-. 0025,ZQDOT= 


-. 0002, 


ZlWl = 


0. 0, ZW = 


0. 0 


PARAM 


ZRP 


=-. 0009 














PARAM 


KPDOT 


=-3. E-6, 


KQR 


=-. 0001,KRDOT= 


-7. E-6, 


K1P1P= 


-8.E-7, KV = 


-. 0007 


PARAM 


KIVIV 


= -. 0009, 


KP 


=-3.5E-5, KR = 


-4. E-5, 


KVDOT= 


-. 00025, KV\\'= 


. 0035 


PARAM 


KDR 


=7. E-5, 


KWP 


= 2. 5E-4 










PARAM 


MQDOT 


= -. 0004, 


MRP 


=.00015, MS = 


4. E-5, 


MW = 


.003, M1W1W= 


-. 005 


PARAM 


MW 


=. 015, 


MQ 


=-. 0025,M1W1Q= 


-. 002, 


MVR = 


-.004, tIRR=- 


. 00055 


PARAM 


HWDOT 


=-. 0002, 


MDS 


=-. 0025, MDB = 


. 0005, 


MlWl = 


0. 0, tIVP = 


. 0009 


PARAM 


NR DOT 


= -5. E-4, 


NPQ 


=-4. E-4,NPD0T= 


-7. E-6, 


NV = 


-. 0075,N1V1V^ 


=. 014 


PARAM 


NR 


= -. 003, : 


NIVIR 


= -. 0045, NP = 


-2. E-6, 


NVDOT = 


. 0003, NDR = 


-. 003 


PARAM 


NWV 


=. 015, 


NWP 


= -. 0002 










PARAtl 


BZB 


=1. 011413E-3 













INCON YADOT = 0.0, RODOT = 0.0, PIDOT = 0.0 
INCON DS = 0. 0 , DB = 0.0, DR =0.0 
CONTRL FINTIM=360. ,DELT=. 01 . DELS=. 5 
PRINT 1. ,YAWDEG,ROLDEG, DEPTH, PITDEG,U 
■>v 

INITIAL 

LC2 = LC"-*2 
IZX = IZ-IX 
lYX = lY-IX 
IZY = IZ-IY 



■•'ERROR LIMIT CALCULATION 

Vr 

DYNAMIC 

IF(U. LT. 15. ) L1MVER=35. 

IF(U. GE. 15. ) LIMVER = 25 
IF(U. GE. 25. ) LIMVER = 15. 

IF(U. LT. 20. 3) LIMH0R=0. 070 

IF(U. GE. 20. 3) L1MH0R=0. 050 

IF(U. GE. 30. 4) L1MH0R=0. 035 

HER = OR YAW - YAW 

ZER = ZOR - DEPTH 

PER = POR - PITCH 

ZERR= LIMIT( -LIMVER , LIMVER , ZER) 



IM 



HERR= LIMIT(-LIMHOR,LIMHOR,HER) 



DERIVATIVE 

* 

’■'PRECALCULATION FOR EQUATIONS OF MOTION 

I'c 

PAl = XDRDR*U*U*DR*DR/LC 
PA2 = XDSDS*U*U*DS*DS/LC 
PA3 = XDBDB*U*U*DB*DB/LC 
PB = YDR’-'U*U*DR/LC 
PC2 = ZDS*U*U*DS/LC 
PC3 = ZDB*U*U*DB/LC 
PD = KDR*U*U*DR/LC2 
PE2 = MDS*U*U*DS/LC2 
PE3 = HDB*U*U*DB/LC2 
PF = NDR*U*U*DR/LC2 
PA = PAl + PA2 + PA3 
PC = PC2 + PC3 
PE = PE2 + PE3 
ABV = ABS(V) 

ABW = ABS(W) 

ABP = ABS(P) 

ABQ = ABS(Q) 

ABR = ABS(R) 

VV\W= V*V + W*W 
AVW = SQRT(VV\vT^) 

ABWP=FCNSW(W,-1. ,0. ,1. ) 

ABVP=FCNSW(V,-1. ,0. ,1. ) 

SAl =+LC*(XQQ*Q**2 + XRR*R**2 + XRP*R*P) 

SA2 =+(ML--'V’>R + XVR*V*R + XWQ--'-'W*Q -ML*W*Q) 

SA3 =+(XVV*V**2 + XWW*W**2)/LC - SIN( PITCH )*(AT+FT+AU) 

SA4 =+(Al*U**2 + A2*U’'-UC + A3-'-'UC*--'-2) /LC 
SBl =+LC*YPQ*P*Q 

SB2 =+(Y\ifP’nv--'P + YV1R1*ABR*AVW’’^ABVP +ML*W*P - HL*U’>R) 

SB3 =+(YlvV*W*V + Y1V1V*AVW*V)/LC + SIN(ROLL)*COS( PITCH)*( AT+FT+AU) 
SB4 =(YR--^R +YP*P +YV*V/LC)*U 
SCI = LC'-''R*(ZRR’'R + ZRP*P) 

SC2 =+( ZVP*V’'=-P + EVR-’^V’^^R + ZW1Q1'’'ABQ*AVW*ABWP + ML'''U*Q - ML*P*V) 
SC3 =+(ZW’>W--'-2 + ZVV*V**2 + ZW1W1*W*AVW + U*Z1W1*ABW + U*U*ZS)/LC 
SC4 = ZQ-->U---Q + ZW---U*W/LC + COS( PITCH) ••■COS (ROLL)* (AT+FT+AU) 

SDl =+(KQR*Q*R + K1P1P*ABP*P) - IZY*Q*R 
SD2 = (KlsT*W*P-BZB*SIN(ROLL)’'^COS( PITCH) )/LC 
SD3 =+(KlVlV*V*AW + KV\(/*V*W + KS*U**2)/LC2 
SD4 = ((KP*P + KR*R)/LC + KV*V/LC2)*U 
SEl = (HRP*P + HRR*R + IZX*P)*R 

SE2 = ((MVR--’^R + MVP*P)*V + M1W1Q*AVW*Q - BZB‘-'^SIN( PITCH) ) /LC 

SE3 =(MVV*V**2 + M\vTV*W**2 + M1W1W*AVW*W +HlWl*U*AV\i/ + U**2*MS)/LC2 

SE4 = HQ*U*Q/LC + (HW*U*W -( 175. 5*FT-219. 5’’'AT)*C0S( PITCH)*. . . 

COS(ROLL))/LC2 

SFl = (NPQ-IYX)*P*Q 

SF2 =+(NWP*W*P + N1V1R*AVW*R)/LC 

SF3 = (NW'W + N1V1V*AVW)*V/LC2 

SF4 = (NP--'^P+NR*R)*U/LC+(NV'’'U*V+( 175. 5*FT-219. 5*AT)*COS( PITCH)*. . . 

SIN(ROLL))/LC2 

SA = SAl + SA2 + SA3 + SA4 

SB = SBl + SB2 + SB3 + SB4 
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SC 


= SCI 


+ 


SC2 


+ 


SC3 


+ 


SCA 


SD 


= SDl 


+ 


SD2 


+ 


SD3 


+ 


SDA 


SE 


= SEl 


+ 


SE2 


+ 


SE3 


+ 


SEA 


SF 


= SFi 


+ 


SF2 


+ 


SF3 




SFA 



ZA = SA + PA 

ZB = SB + PB 

ZC = SC + PC 

ZD = SD + PD 

ZE = SE + PE 

ZF = SF + PF 

^EQUATIONS OF MOTION 

Vf 

UDOT =( COFAA*ZA+COFAB’''ZB+COFAC*ZC+COFAD*ZD+COFAE--' ZE+COFAF'-' ZF) /DEL 
VDOT =(COFBA*ZA+COFBB*ZB+COFBC’'ZC+COFBD-''ZD+COFBE-->ZE+COFBF---ZF)/DEL 
WDOT =(COFCA*ZA+COFCB-'ZB+COFCC*ZC+COFCD-'-ZD+COFCE*ZE+COFCF“ZF)/DEL 
PDOT =(COFDA*ZA+COFDB*ZB+COFDC*ZC+COFDD*ZD+COFDE'>ZE+COFDF*ZF)/DEL 
QDOT =(COFEA*ZA+COFEB-’^ZB+COFEC*ZC+COFED*ZD+COFEE*ZE+COFEF'“'ZF)/DEL 
RDOT =(COFFA*ZA+COFFB*ZB+COFFC*ZC+COFFD*ZD+COFFE--’^ZE+COFFF*ZF)/DEL 

*AUXILARY EQUATIONS 

ZODOT =-U*SIN(PITCH)+V*COS(PITCH)*SIN(ROLL)+W*COS(PITCH)*COS(ROLL) 
PIDOT = Q-'-'COS( ROLL) -R-'^SIN( ROLL) 

YADOT = (R*COS(ROLL)+Q*SIN(ROLL))/COS(PITCH) 

RODOT = P+YADOT*SIN(PITCI{) 

U = INTGRL(UC,UDOT) 

V = INTGRL(0. ,VDOT) 

W = INTGRL(0. ,WDOT) 

P = INTGRL(0. ,PDOT) 

Q = INTGRL(0. ,QDOT) 

R = INTGRL(0. ,RDOT) 

DEPTH = INTGRL(0. 0, ZODOT) 

ROLL = INTGRLCO. 0, RODOT) 

PITCH = INTGRLCO. 0, PIDOT) 

YAW = INTGRLCO. , YADOT) 

’■-COMPENSATOR GCll 

Cll = -K1---ZERR 

C12 = LEDLAGCO. , 1. 0,0. 1 ,C11) 

DB = REALPLCO. ,. 667 ,C12) 

’■•'COMPENSATOR GC22 

C21 = -K2’-PER 

DS = REALPLCO. ,. 667,021) 

’■^COMPENSATOR GC 

Cl = -KIH-HERR 

C2 = LEDLAGCO. ,100. ,10. ,C1) 

DR = REALPLCO. ,. 667, C2) 

* 

DBDEG = DB’^^57. 296 
DSDEG = DS’^-57. 296 
DRDEG = DR’^--57. 296 
PITDEG= PITCH--57. 296 
ROLDEG= ROLL’^57. 296 
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YAWDEG= YAW*57. 296 

SAVE 0. l,V,ZDOT, DEPTH, PITDEG,ROLDEG,YAWDEG,DRDEG,DSDEG,DBDEG 
GRAPH( DE=TEK6 18 )TIME , ROLLDEG , YAWDEG , V 
LABEL 15 DEGREE COURSE CHANGE U=10 KTS. 

’’•'GRAPH( DE=TEK6 18 )TIME , PITDEG .DEPTH , ZDOT 
*LABEL 10 FEET DEPTH CHANGE U=10 KTS. 
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